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3. 


Overview 


3.1 Relationship to Other GNSC Functions 

The GN&C on-orbit flight control function is accomplished in a 
software module referred to as the Flight Control (FC) or On-Orbit 
Flight control (OPC) module. Figure 3.1-1 shows the relationship of 
the FC module to other GN&C major functions. 

3.2 On-Orbit Flight Control Module Overview 

Figure 3.2-1 illustrates the interface categories of the FC module, 
and indicates the general functional relationship of the reconfiguration 
logic and control law implementation within the FC module. 

3 . 3 Abbreviations 

The following specialized acronyms or abbreviations are used in 
this publication: 

eg center of gravity 

DAP digital autopilot 

DSC Display and Control 

FC Plight Control 

GNSC Guidance, Navigation and Control 

GUID Guidance 

MSC Moding, Sequencing, and Control 

NAV Navigation 

OFC On-Orbit Plight Control 

OMS Orbital Maneuvering System 

RCS Reaction Control System 

RHC Rotational Hand Controller 

ElM Redundancy Management 

SP specialist function 

SOP Subsystem Operating Procedure 

TBD to be determined 

THC Translational Hand Controller 

TVe thrust vector control 

The tabular parameter descriptions in Section 4 use the following 
type code : 

A(i) - Array (i) 

V{i) “ Vector (i) 

MCi,j) - Matrix (irj) 
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Pigure 3.1-1. 


Relationship of PC module to other GN&C major functions. 














Figure 3.2"1. Relationship of FC module reconfiguration logic and control laws. 











S - Scalar 

B - Boolean 

I - Integer 


Examt-le: A(3)I signifies an array of three integers. 


4 - Functional Requirements 

4 . 1 Interface Requirements 


Overall interface requirements for the OFC module are given in 
Tables 4.1-1 and 4.1-2. This interface specification presupposes the 
existence of two specialized software modules (possibly located within 
the SOP group) to interface the OFC module with the rotational hand 
controller and the switch panel. RHC_READ will convert the controller 
scalar outputs to integer form (with a range of -1,0,1, where a nonzero 
value indicates the controller is out of detent and gives the sense of 
the deflection) and will set a flag when the controller is deflected 
beyond the soft stop. The routine will incorporate hysteresis to prevent 
chatter at the switching points. PANEL_SWITCH_INTERP will convert the 
panel switch settings to a form directly useable by the OFC module. In 
particular, the module will provide the following: 


Discretes Integers Scalars 

High/low rotation Manual rotation submode Attitude deadband 
acceleration 

High/low translation Manual translation submode Manual rotation dis- 
acceleration crete rate 


Nomina 1/vemier RCS 
jets 


Manual rotation pulse 
size 

Manual translation 
pulse size 

Off-axis rate thresh- 
olds for compensation 


Some of the scalars may be selected from a pad-loaded pool using 
DAP load A/B switches, and others may be selected by dedicated switches 
such as pure/crdss-coupled, high/low deadband, etc. PANEL_SWITCH_IWTERP 
will also accept override inputs from the OFC module when certain RCS 
parameters must be forced, as during RCS assistance of TVC, and will be 
responsible for illuminating the switch annunciators to acknowledge a 
selection or call attention to an override condition. 
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Also assumed in this definition is the existence of a specialist 
function (SF ) , which will enable the alteration of values in memory. 

The SP would operate through the displays and controls (D&C) software 
but on a nondedicated basis, enabling access to any region of memory. 

4.2 Detailed Functional Requirements 

This section describes the functional requirements of the OFC 
module in two subsections, reconfiguration module and control law 
module . 

4.2,1 Reconfiguration Module 
4 . 2 . 1 . 1 . Function 

Figure 4. 2. 1.1-1 illustrates the major reconfiguration functions 
of OPC_RECON and their general relationship to the configuration- 
controlling inputs of the OFC module. The decision is first made as 
to whether TVC or RCS operations are needed. The required TVC or RCS 
driver modules are set up and executed, and the required component 
modules of the TVC and/or RCS DAF are likewise set up and executed. 
Setting up includes initializing, and specifying configuration-dependent 
parameters such as rates and gains, in response to a commanded mode or 
configuration change. Equally important to effecting such a change are 
the cleanup activities, which include forcing DAP outputs to zero or to 
nominal values when the particular DAP has been deactivated, and making 
last calls to certain DAP modules for the same pu-^^ose. Execution 
includes selecting and sequencing the control law modules as dictated 
by the moding inputs. Not shown in the diagram are the more routine 
executive duties of OFC_RECON, such as clocking the "slow" (5/6 Hz) 
driver modules, and calling the State Estimator modules every OFC 
minor cycle - 

For clarity in presentation, the remainder of this section, which 
describes the OFC_RECON execution-sequencing function, distinguishes 
among three types of variables. First, there are the controlling inputs, 
generated both externally to OFC and within the control laws, in mean- 
ingful logical combinations. Second, there are the resulting "outputs" 
of OFC_RECON, consisting of sequenced calls to selected control law 
function modules. Third, there are the OFC modes, wliich are the . 
definitions by which the OFC_RECON functions and their purposes are 
made more easily understood. 
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Figure 4. 2. 1.1-1. OFC reconf iguratj i 











Table 4. 2. 1.1-1 relates the first two variable types, in conjunction 
with the control law module block diagram. Figure 4. 2. 2-1. The "switches" 
in this diagram control data flow among the function modules, and their 
positions define which modules are needed and, to an extent, their 
sequencing requirements. (If, with a given switch configuration, 
module A's outputs are not received anywhere, then module A is not 
needed. Also, if module B drives only module A, it too is not needed. 
Generally, if B drives A and both are needed, B should precede A; 
however, exceptions to this can be found as "one cycle delays" in 
Figure 4. 2. 2-1.) Logical combinations of controlling inputs required 
for each switch position are given in the referenced table. 

The first and third variable types are related in Table 4. 2. 1.1-2, 
which defines an OFC mode-submode-condition combination for each 
significant combination of inputs. 

With the OFC modes defined, the OFC_EECON actions for these modes 
are described in two ways. First, Table 4. 2. 1.1-3 relates the OFC modes 
to the requisite function modules by specifying a set of switch positions 
(referring again to Figure 4. 2. 2-1) for each modal subdivision. Second, 
the diagrams of Figure 4. 2. 1.1-2 present an OFC mode-by-mode specification 
of the required sequences in which the control law function modules must 
be invoked. The requirements are read Vertically from the top of the 
diagram. Requirements for sequential execution are indicated with 
solid line arrows running down from "earlier" modules to "later" modules. 
For those cases in which two or more modules are at a given level there 
is no execution sequencing requirement among these modules. 

For example, in diagram/mode I.A.I., module 1.4 (AUTOJTVC) must 
be executed before module 4.4 in a given OFC minor cycle; similarly, 
module 4.G must be executed prior to module 4.4, There is no requirement 
as to the execution sequence of 1.4 with respect to 4,6 (or 3,1). (Later 
developments may indicate that transport delays might be alleviated by 
executing one or the other of these first, but this document does not 
deal with such considerations at present.) Both modules 4.11 and 4.10 
must be executed before 4.12 on a given FC cycle . 
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Table 4.2.1.X-1. Relabianship between OEC RECON outputs 

and moding Inputs {page 1 of 2) . 
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!Pable 4.2.1. 1-1. Relationship between. OPC RECON outputs and 
moding inputs (page 2 of 2). 


OFC_RECON OUTPUT 
(Refer to 
Eig. 4. 2. 2-1) 


SV?ITCH POSITION 



(Note 3) (Note 2) 
B 


MODING INPUT COMBINATION (See Note 1) 


RCS_ASS1ST_R0LL + [RCS_ROTATlON • RGS_AUTO_MANUAL 
•DETENT] + lRCS_ROTATION* [RCS_AUT0_MANUAI. t DETENT] 
-SOPTSTOP*ROTJDPTION=3 (DISC) ] 

RCS_ASSIST_ROLL * RCS_ROTATION • [ RCS__AUTO_MANOAL 
+ DETENT] . [SOFT_STOP + ROTJOPTION=1 (ACCEL) ] 
RCS_ASSiStJROEL • RCS_ROTATION • [ RCS JIDTO Ji^UAL 
+ DETENT] • SOFT_STOP ■ ROT_OPTION=2 (PULSE) 
RCS_ROTATION • RCS_ASS 1ST JROLL 


RCS_ROTATION + [RCS_TRANSLATI0N‘N0M_VERNIER_SW3 
t RCS_ASSIST_R0LL 

RCSJROTATION ' UCSJTRANSLATION + NOiTVERNIER^SW ] 
• RC S_AS S IS TJROLL 


RCS_ASSIST_ROLL 


RCS_ASS IST_ROLL 


RCS_ASSIST_P_y 


RCS ASSIST P Y 


TVC_AUTO_MANUAL 

TVC_AUTO__MANUAL * RCS_ASSISTJP_Y 
TVC_AUTO_MANUAL • RCS_ASSIST_P_Y 


[OMS_FAIL_DETECT‘TVC] + [ OMS_P RETHRUS T • CL0SEDJDPEN__ 
LOOP_TRIM- ONE_ENGINE] 

[OMS_PRETHRUST • 0MS_FAIL_DETECT] + [ OMS_P RETHRUS T ' 

* CL0SED_0PEN_L00P_TRIM] 

OMS_SELECTj_ • OMS_SELBCT2 * OMSJPRBTHRUST - CLOSED_OPEN_ 
LOOP TRIM 


S13 

(Note 2) 

A 

B 

OMS_FAIL_DETEGT • TVC 

EoMS_FAIL_DETECT*TVC] + [OMS_PRETHRUST- FIRST PASS 
•RCS] 

S14 

'Note 4) 

A 

LATCH_ASSIST_PITCH_YAW* FAILJED • TVC 

B 

L74.TGH_ASSIST_PITGH_YAW + FAIL_ID + TVC 

SIS 

A ' 

TVC ,+ OMS_PRETHRUST 


B 

TVC*OMS PRETHRUST 
































Notes 


1. itogical symbols used: + = orT(+)= exclusive or/ • “ and, 

X = not X. 

2* The following mode abbreviations are used: 

TVC = [ OMS_ARM_REQ^ • OMS_ON_EEQ • 0MS1_FAIL3 -t- 
[0MB_AR14_REQ2 * 0M3_0W_REQ2 ■0MS2_FAIL3 
PAIL_ID = 0MS1_FAIL + 0MS2_FAIL 
ONE_ENGINE = OMS_SELECTj^ 0 0MS_SELBCT2 
RCS_ASSIST_ROLL = TVC*[PAIL_ID + 0NE_ENGINE] 

RCS ASSISTjPJf = RCS _ASSIST_ROLL* ASSIST_PITCH_YAW (See Note 4) 
DETENT = value of RHC_STATE is 0. 

3. The associated modules are executed only once during the 
OMS_PRETHRUSt initialization pass or during the first pass 
after FAIL_ID. 

4. 0FC_EEC0N logic permits cycling between execution of RCS_ 
ASSIST_PITCH_YAW and TVC_LAW_PITCH_YAW and back to RCS_ 
ASSIST_PITCH_YAW once (both modules may not be executed 
in the same pass) ; once this cycling has occurred, 0PC_ 

RECON logic is "latched” to invoke RCS_ASSIST_P1TCH_YAW 
for the duration of the OMS burn. 

This is mechanized in OFC_EECON as follows: ASSIST_PITCH_YAW 

is set to 1 if less than TBD time has elapSed since PAIL_ID, 
and afterwards is controlled by the module PITCH_YAW_ASSIST_ 
COMPUTATION; however, if ASSISt_PITCH_YAW makes the successive 
transitions 1-^-0, 0-^1, LATCH_ASSIST_PITCH_YAW is set to 1 and 
holds ASSIST PITCH YAW “ 1 for the remainder of the TVC mode. 


IS 


In general, "bhe sequential execution requirements are deteimiined 
by the data flow requirements between OEC modules. Occasionally, how- 
ever, an OPC module must provide OFC_PiJGDN with information to decide 
which modules to invoice or to determine parameter settings for sub- 
sequently invoked OPC modules.. Also, in the case where an automatic 
driver is required to generate display data, but an attitude hold or 
manual driver is actually to control the RCS D2kP, then the "controlling" 
driver must be called after the display-generating driver to overwrite 
the relevant RCS DAP commands. Such exceptional relationships are 
indicated in the diagrams with dashed lines rather than solid lines. 

The diagrams are preceded by an outline listing the OPC modes 
in the order of the diagrams. The module numbering corresponds to 
that of the subsections of Section 4.2,2. 
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Table 4, 2. 1.1-2. Eelationships between nioding inputs and OFC modes. 


MODINS INPUT COMBIHATIDN (SEE NOTE tl 


(OMS_ARM_REQ, • OMS_ON_REO, • OMSl_FAIL]4- 


(OMS_AnM_HEQ2 » OMS_ON_REOj • 0MS2_FAIL] 


TVC AUTO MANUAL/ 


TVC_AUTO_MANUAU 


OMS_AnM_REQ, t OM5_ON_REQ, • 
QMS_ARM_REQ2 * Oiyi5_ON_REQ2 * 


OMS FAIL OETECT 


OMS_FAIL_DETECT . OMSl_FAIL* 


0MS2„FAIL 


[QMS1_FAIU + 0MS2_FA|L + (OMS_SELECTi 0 
OMS^SELECTjll • RCS_ASSIST„P_Y (SEE NOTE 41 


RCS_ASSIST_P_V (SEE NOTE 4) 


[<T0O TIME SINCE BCS_ASSIST_ROLU + 
LATCH_AES!ST_P17CH_YAW (SEE NOTE 41 


t>TBD TIME fNCE RCS_ASSIST_HOLU! . 


LATCH_ASSIST_PITCH„YAW (SEE NOTE 4) 


10MS_ARM_REQ, + OMS_ON„REQ, + OMS1_FAIL]. 


I0MS„ARM_REQ2 + OMS_DN_REa2 + OMS2_FAIL] 


RCS_ROTATION 


RCS_AUT0_MANUAL * (RHC_STATE = 01 


ATT_MNVR 


ATT MNVR 


TWO AXIS 


TMREE_AX1S 


BBQ 


LCL VERT ATT 


payed Sup cmds 


tracking 


OFC MODF.SUBMODE & CONDITION (SEE NOTE 21 


TVC 


flCS 


AUTO/ 

manual 


(SEE 
NOTE 31 


NOMINAL 2-ENGINE BURN, NO FAILURE 


FAILURE DETECTION WITHOUT IDENTIFICATION 


RCS ASSIST ROLL ONLY 


RCS ASSIST ROLL AND PITCH YAW 


UNCONDITIONAL 


CONDITIONAL 


ROTATION 


AUTO 


ATTITUDE 

HOLD 


ATTITUDE 

MANEUVER 


TWO AXIS 


THREE AXIS 


BARBEOUE 


LOCAL VERTICAL 


PAYLOAD 


TRACKING 




















ATT_MNVR 




M 1 ^ l.( UUC 

MANEUVER 



TWO„AXlS 





TWO AXIS 


JHREE.AXIS 





THREE AXIS 

BBQ 





HARBEOUe 

lcl_vert_att 





LOCAL VERTICAL 

payld_sup_cmds 





PAYLOAD 

tracking 




TRACKING 

□MS_PRETHRUST 





OMS PRETHRUST 
MANEUVER AND 
OMS ENGINE TRIM 



CLOSED_OPEN_LOQP_TRIM 






CLOSED* LOOP 
TRIM 


CLOSED_OPEN_LGOP_TRIM 






OPEN-LOOP 

TRIM 

(□MS_SELECT, fi) OMS_SELECT2l 







2 ENG. 

OMS_SELECT.| © 0MS_SELECT2 







1 ENG. 

RCS_AUTO_MANUAL + [RHC_STATE=AO] 



MANUAL 



l»>SEE NOTE 5 

IROT„OPTION;^j;tS “ SOFT_STOP;^XtS 




ACCELERATION 


tROT_OPTIQNj^x|S 21 • SQFT_STOP;i,XIS 




PULSE 

|ROT_OPTION^j{IS “ 31 * SOFT_STOP^^|g 




DISCRETE 

BCS_TRANSLATlON • KQM_VERNIER_SW 


TRANSLA- 

TION 



J 

RCS_AUTO_MANUAL • lRHC_STATE Oj 

— 


AUTO 



RC3_AUTO_MANUAU +IRHC_STATE V=0] 


MANUAL 


> 

>■ (SEE NOTE 51 

tRans_optidN;^xis “ 

— 



acceleration 

1 

J 

TRANS„aPTIONy^XIS = 2 




PULSE 


NOTES: 1. tOGICAL SVlVlBOLS USED; += OR. 0 = EXCLUSIVE OR, • = AND, X “ NOT X. 


2. ALL MODES IN A GIVEN CONTIGUOUS VERTICAL STACK ARE MUTUALLY EXCLUSIVE 
EXCEPT RCS ROTATION/TRANSLATION. 

3. ALTHOUGH MUTUALLY EXCLUSIVE, AUTO/MANUAL TVC ARE TREATED TOGETHER 
TO AVOID REPETITION. 

4. this condition is explained in TABLE 4.Z1 1-1. 

5. manual RCS SUBMODES MAY RE MIXED AMONG THE 3 AXES. 

to 
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DFC HQO^ JUWEOOe & DOHDTTHm 



2 e«GIWE5, NO FAILIWE 



AUTO 

KS Awrr npit. only 



CONDmoNAL 



UNCONamoNAL 

wmm. 

1 z ENGINES, HQ FAILURE 

m 

FAILpET^cr, HO ID 


DCS AS»ST ROtL ONLY 


RCS ASSIST POLL 

CONOmDNAL 


AND nTCH*TAW 

UIHCWOmOKAl 


ATT. MOLD 


Atrto 


mOTAVlOHi 


MANUAL 



TWO AKIS 


THREE AXIS 


BARSEODE 


LCX:AL VERTICAL 

ATTITUDE 

PAVLOAD 

WANEUVER 

TRACKING 



WITWUZATIDN 

PASS 


Z EHQINES 


□MS 


1 ENGINE 


PftETWttUSr 

CLOSED* LOOP TRIM 



LATER PASSES 

1 ACCELERATION 



t DISCngTE 

Atjro 


TRAP/$> 

LATION 


MANUAL 


ACC^LEBATIOH 

rULSE 


modes and OFC eecon outputs 


oFc.flBcoM oumn* inefer to na 4^2-11 switches and K>smo«s 

tNUMiCflS m PARENTHESES REFER TO NDTE5» 
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OFC MODES AND SDBMODES 


1. Nominal 2-Engine, No Failure 

2 . Failure Detection , No Failure Id ' n 

a. First Pass 

b. Subsequent Pass 

3. RCS Assist - Roll Only 

4. RCS Assist - Roll and V/'Z 

a* Not Datched and Time > TBD 

b. Latched or Time < TBD 


1.-4. (Sams as above) 


1. Two Axis Att. Mnvr 

2. Three Axis Att Mnvr 

3. Barbeque ^ Maneuver 

4. Attitude Local Vertical Attitude Hold 

5. Payload Attitude \ 

6. Mi sc Tracking I 

7 . OMS Prethrust 

a. First Pass 

1) Open Loop Trim 

a) 2 -Engine 

(1) Maneuver 

(2 ) Attitude Hold 

b) 1 -Engine 

(1) Maneuver 

(2) Attitude Hold 

2) Closed Loop Trim 

a) Maneuver 

b) Attitude Hold 

b- Subsequent Pass 

1) Maneuver 

2) Attitude Hold 


1- Two Axis 

a. No Att Hold (= Free Drift) 

1) Accel (all axes) 

2) Pulse (all axes) 

3) Mixed Accel and Pulse 

b. Att Hold (Disc, all axes) 

c. Mixed Modes, axis by axis 
2.-7. (Same as above) 


III. RCS TRANS- 
LATION 


A, AUTO 


B. MANL 


1. Accel, Accel 

2 . Pulse , Pulse 

3. Accel, Pulse - 

4. Pulse, Accel 


Figure 4. 2*1. 1-2. OFC control law function module sequencing requirements 

(page 1 of 21) . 
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I.A.1 

OWIS TVC AUTO 


NOMINAL 2-ENGINE 


1.4 AUTO 


i_TVC^ 


i\Q OMS ENG CMD 


3.1 PARTI FILTER 


4.4 GUIDANCE COMPENSATION 



4.10 TVC_LAW_ 
PITCH YAW 


4.12 TVC MIXER 


4.1 DELTA_OMEGA_ 
OMS Eng 


3.2 PART2_FILTEB 


FAILURE DETECTION 



©Executed first pass Fail Detection cnty 


Figure 4 » 2.1. 1-2 . OFC control law function module sequencing requirements 

(page 2 of 21} . 
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LA.3 

TVC AUTO 

RCS ASSIST ROLL ONLY 



Figure 4. 2*1. 1-2. OPC control law function module sequencing requirements 

(page 3 of 21) . 
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l,A,4.a 


TVG AUTO 

RCS ASSIST (^ILURg ID*N) 

• ROLL ASSIST & P/Y ASSIST (UNLATCHED, ASSIST_TIMER > TBD) 



Figure 4. 2. 1.1-2. OFC control law function module sequencing requirements 

(page 4 of 21) . 
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l.A.4.b 


TVC AUTO 

RCS ASSIST (FAILURE ID'Nl 

• ROLL ASSIST 8t P/Y ASSIST' 

9 LATCHED OR ASSIST TIMER < TBD 



Figure 4-2.1, 1-2 


OFC control law function module sequencing requirements 
{page 5 of 21) . 













■ ii 

. • Ii 
1 " 

■I 

. .-t 

...■V 

1 1.B.1 

QMS T VC MANUAL NOMINAL 2-ENGINE 



I.B.2 


FAILURE DETECTION 




@ Executed fli^ pass Fail Detection only 


Figure 4. 2.1. 1-2. 


OPC control law function module sequencing requirements 
(page 6 of 21) . 
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B.3 


TVC iVIANUAL . 

RCS ASSIST ROLL ONLY 


4.6 OMS ENG CMD 


1.B MANUAL 


4.10 TVC LAW PITCH YAW 


4.1 DELTA„OMEGA_ 
□MS ENGINE 


Figure 4.2.1.1"2. 


4 


OPC ccufcrol law func 
(page 7 of 21) . 
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module sequencing requirements 












TVC MANUAL 

nCS ASSIST tFAILURE [D'Nj 

• ROLL ASSIST & P/Y ASSIST (UNLATCHED, ASS|ST„TIMER > TBD) 



Figure 4.2.1. 1-2. OFC control law function module sequencing requirernents 

(page 8 of 21) . 
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t.BAb 


TVC MANUAL 

RCS ASSIST (FAILURE IP'Nl 

• ROLL ASSIST & P/Y ASSIST 

• LATCHED OR ASSIST TIMER < TBD 



Figure: 4. 2. 1-1^2. OFC control law function module sequencing 

{page 9 of 21). 


requirements 
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II.A.1 through ILA.6, casea 
RCS ROTATION 


AUTO NO ATTITUDE HOLD 



Figure 4. 2. 1.1-2. OFC control law function module sequencing requirements 

(page 10 of 21). 


33 



Figure 


ll.A.1 through M.A.B, case b 

RCS ROTATION AUTO ATTITUDE HOLD (Auto driver for display only) 



.2. 1.1-2. OFC control law function module sequencing requirements 
(page 11 of 21) . 
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|[.A.7,a.1.a.1 


OMS P T; FIRST_PASS; OPEN LOOP TRIM; NO ATT HOLD; TWO ENGINES 



Figure 4. 2. 1.1-2. OFC control law function module sequencing requirements 

(page 12 of 21) . 
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n.A.7.a.1.a,2 OMS_P_T; F1RST_PASS; OPEN LOOP TRIM; ATT HOLD; TA'VO ENGINES 

(OMS PRETHRUST MANEUVER FOR DISPLAY AND OMS ENGINE TRIM ONLY) 



Figure 4. 2. 1.1-2. OFC control law function module sequencing requirements 

{page 13 of 21) . * ' 
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ll.A.7,a,1,b,2 


OMS„P_T; FIRST PASS; OPEN LOOP TRIM; ATT HOLD; ONE ENGINE 
(OMS„PRETHRUST_MANEUVER FOR DISPLAY AND OMS ENGINE TRIM ONLY) 



Figure 4. 2. 1.1-2. OFC control law function module sequencing requirements 

(page 15 of 21) . 
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. Figure 4. 2. 1.1-2. OFC control law fuiiction moflule sequencing requirements 

(page 16 of 21) . 
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3.2 PART2_F1LTEB 




Figure 4. 2.1. 1-2. OFC control law function module sequencing requirements 

(page 17 of 21) . 
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RCS HOTAT!ON:MANUAL (OPTIONAL AUTO DRIVER FOR DISPLAY ONLY) 


OPTIONALLY, ANY ONE OF THE FOLLOWING: 

1.2 

ATTITUDE_LCL_VERTICAL 

1.5 

BARBEQUE 

1.7 

MISC_TRACKING 

1.8 

OMS_PRETHRUST_MANEUVER 

1.9 

PAYLOAD_ATT1TUDE 

1.13 

three_axis_attitude_maneuver 

1.16 

TWO_AXIS_ATTITUDE_MANEUVER 


3.1 PARTI FILTER 



1.11 R0T_D1SC 


1.1Q ROT ACCEL 


1.12 ROT_PULSE 


2.3 RCS ERRORS 


2.2 PHASE PLANE 


2.1 JET SELECT 


3.2 PART2_F1LTER 


ANY OR ALL OF THESE MAY -BE 
EXECUTED ON A GIVEN PASS. SINCE 
THEY ARE CREW-SELECTABLE 
AXIS-BY-AXIS; IF HOT_DtSC tS 
NOT SELECTED ON ANY AXIS, 

1.11, Z3 AMD 2.2 NOT NECESSARY 
TO EXECUTE. 


Figure 4. 2. 1.1-2. OFC control law function module sequencing requirements 

(page 20 of 21) . 
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I II. A. 


RCS TRANSLATION AUTO 



IILB. RCS TRANSLATION MANUAL 



EITHER OR BOTH OF VHESE 
MODULES MAY BE EXECUTED 
IN A GIVEN CYCLE, BECAUSE 
THEY ARE SELECTABLE 
AXIS-BY-AXIS BY THE FLIGHT 
CREW. 


Figure 4. 2. 1.1-2. OPC control law function module sequencing requirements 

(page 21 of 21) . 
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4. 2. 1.2 Processing Rate 

OPC_RECON is processed at 25 Hz. 

4 . 2 . 1 . 3 Interface Requireinents 

The interface requireinents of OPC_RECON are given in 
Table 4. 2. 1.3-1. 


4. 2, 1.4 Control Law Function Module initialization 

Table 4, 2. 1.4-1 lists the conditions for initializing the control 
law modules. The modes, submodes and conditions are the same as those 
of Table 4. 2. 1.1-2 with the following exceptions: 

1) First pass/restart is any entry into OPC_RECON with the 
OPC_RESTART flag set- 

2) TVC fail-detect is the presence of OMS_PAIL_DETECT during 
TVC mode, regardless of whether an identification (OMSl_PAIL 
or 0MS2_FAIL) is present. 

The behavior of the individual control law function modules upon 
initialization is described in subsections 4. 2, 2,1 through 4. 2. 2. 4. 
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TABLE 4^2. 1.3-1 OFC^EECOM INTEEFACE KEQUIBEHEHTS 


1 

1 

1 »A»S 

I 

1 

1 

1 BE5CHIBII0B 

L_ 

I 

J SOURCE OH 

I DESTIBATIOK 

_JI 

1 

1 

1 TYPE 
1 

1 

1 

1 EANGE 

_ I 

1 

1 

[ UNIT 

1 

I 

I SAflPLE 

1 BATE (H7) 
t 

I 

1 

I 

1 

' 

JZnpots 

1 

1 

1 

1 

„J 

1 

1 

1 

1 

' 'i 

t 


1 

i 

jHCS HOTiTlOH 

jBCS iratatlcn node enable 

I BSC 

1 B 

10,1 

1 none 

125 


1 

J 

1 (1-enable) 


J 

I 

1 

1 


1 

f 


1 

1 

1 

1 

1 


1 

JECS_aUIC_iiAHUAI 

)BCS auto/nanual select (1=aui:Q; 

1 H5C 

IB 

|D,1 

1 none 

■ f25' 


1 

1 

( 

io=nanual) 

. I-- - 

1 

1 .. 

1 

i- 

1 

1 

1 

1 

1 


1 

J. 

lATS MHVH 

|Auta SCS rotation .ode select 

[HSC 

|B 

[0,1 

1 none 

[25 


1 

1 

i (1=aan6aver: tva axis^ three 

1 

1 

1 

1 

1 




I axis, OHS prethrust, local 

1 

1 

1 

1 

1 



1 

j vertical, payload, tracking or 

t 

1 

1 

1 

1 


1 

1 

[barbegue; 0-hold) 

i 

i 

1 

1 

I 


1 

\ - _ . 


1 


f 

_1 

1 


i 

iTiiO AXXS 

(Txo axis naneuver enable 

IHSC 

1 B 

10,1 

(none 

(5/6 ■ 



1 

J 

i (1=enable) 

1 

1 

J 

t 

1 

1 

t 

f 


1 

1 

1 TREES AXIS 

[Three axis aaneuver enable 

1 «sc 

IB 

|0,1 

[none 

|5/6 


1 

1 

J 

I (1=enable) 
i 

1 

1 

1 

1 

. 1 

1 


1 

JOBS PEEIHROST 

ions prethrust aaneuver enable 

|MSC 

|B 

|0,1 

t none 

(5/6 


1 

1 

1 

I (loanable) 
1 

t 

1 

1 

1 

1 

1 

1 


1 

1 

IICE_VEBa_ATT 

1 Local naneuver enable (1=enable) 

tasc 

|B 

[0,1 

Inone 

15/6 


1 


.. -1- - . . _ 




I 

1 

1 


i 

IPAXLD SUP CKDS 

f Payload supplied connands 

J BSC 

|B 

10,1 

1 none 

|5/6 


1 

1 

laaneuvecs enable (1=euable) 

1 

I 

1 

1 

1 


1 

J 


1 


1 

„J. 

1 


1 

ITBACKIHG 

t Tracking oaneuver enable 

1 HSC 

1 B 

[0,1 

[none 

15/6 


1 

J 

i {1=enabie) 

1 

1 

1 

1 

! 


1 

1 

1 

J . . 


_J 

1 

1 


1 

IBBQ 

J Barbecue oaneuver enable 

JHSC 

IB 

|0,1 

'none 

15/6 


[ 


i (1=enable) 

f 

1 

1 

1 

1 


1 

1 _ 

I - - 

i .. . 

_1 

1 

1 

1 


—i 

|BCS THAKStATlON 

I ECS translation node enable 

IflSC 


|0,1 

1 none 

[25 


1 

1 

j‘(l=enable) 

1 

1 

1 

1 

1 


1 

J - 

I . - - 

.1 .... . 

_i 

_I 

„i 

i 


, 1 

JOBS ARH EEQ 

I OHS engines arsing request 

IHSC 

|A(2)B 

[0,1 

1 none 

125 


1 

( 

] (1=reguest) 

i 

1 

1 

1 

1 


1 

1 

I 


t 

1 

,_i 

( 


1 

(CBS OB EEQ 

JO HE engines tnrn-cn request 

) HSC 

|A{2)B 

10,1 

{none 

125 


! 

t 

J 

I (1=re guest) 
1 

1 

J 

1 

1 

1 


1 

-_i 


ORIGIWAI, PAGE 2S 
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TABLE 4.2. 1.3-1 OFC_EECOH INTEEF&CE KEQUIEEKESTS 


1 

1 

1 NAME 

I 

1 

J DESCBIETIOH 

1 

1 

1 SOURCE OE 

1 DESTIKATIOH 

1 

1 TVPE 

1 

1 

1 RANGE 
1 

1 

1 

I HHIT 

1 

i SAMPL? 

t FATF fH7) 

1 

I 

I 

1 

1 









live AUTO MAKUAl 

live auto/iaanual selecr (1=aato; 

|HSC 


|0,1 

1 none 

1 

F 

1 

J _ „ . 

I0=aanual) 

1 - 

1 

1 

1 

1 

i 

1 

1 

JL 

1 

1 

ICIOSEU CEEH LOOP 

.TK-|OHS gisbal triu value select 

|HSC 

1 u 

10,1 

Inone 

1 1/maneuver 
1 

1 

IIH 

i (1=closea loop; use value 

1 

1 

1 

1 

1 

{ 

Irenainiug £ros previous OBS burn; 

1 

1 

1 

{ 


1 

1 

1 O^opeu loop; use value coiaputed 

1 

1 

1 

1 

1 
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1 
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!B 
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I 
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1 


__i 
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flag 
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|25 

1 

I 
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1 

1 

1 

1 

1 

1 

1 

I 


1 

1 

1 
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1 

1 
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(Hodule initialization 

flag 
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1 

( 

( (1=initialization) 


1 

1 

1 

1 

1 

1 

1 
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{ 

.1 

t 

. t 

_ 1 

i 

(IHIT EOT DISC 

(Hodule initialization 

flag 

[HOT DISC 

IB 

10,1 

(none 

|25 

! 

1 

I n=initialization) 


1 

1 

1 

1 

1 

1 

— 1 


SAHELE 


I IH IT_ A HIT UDE_LC L_ V- 
lEHTicai 

1 


Hodule initialization flag 
( 1=i n itia 1 iz at ion ) 


(ATTITUDE LCL VERTICAL 

I 


0»1 


5/6 


-L 
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1 

1 

1 

1 


1 

1 SOUPCE OR 

1 

1 

1 

1 

1 

! 

1 

r SAMFL? 

1 

1 

1 MilE 

i- 

1 DESCEIETION 

J 

i DESXIHATIOK 

I 

i 

TYPE 1 range 

_ _ i 

[ PP1.IT 

i 

[ FATE (HZ) 
1 

1 

P 


IINII_BABBEQUE 

IHcdule initialization 

flag 

[ BABBEQUE 

IB 

|B,1 

1 none 

15/6 

1 

1 

J 

i (1=initialization) 


1 

1 

1 

1 

_ J_ 

1 

1 

1 

1 

- i 

UNIT ATTITUDE HCID 

1 Module initialization 

flag 

[ATTITUDE HOLD 

“fr 

10,1 

1 none 
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1 

1 

1 

1 1 l=lnltialization) 

1 


1 

J 

1 

_i _ 

1 

P 

1 

P 

i 

1 

1 

UNIT MANUAL TVC 

1 Module initialization 

flag 

[MANUAL rvc 

IB 

|0,1 

t none 


1 

1 

1 

1 (1=initialization) 


[ 

1 

1 

_J_ 

1 

1 

t 

1 

1 

J. 

UNIT ECS ERHOfiS 

1 Module Initialization 

flag 

[ECS ERRORS 

|B 

10,1 

I none 

1 25 

1 

1 

1 . . 

1 (1=initializationJ 

1 - -- 


1 

/ 

1 

I 

i 

1 

1 

1 

1 

i 

|ISXT_PBASE EL A HE 

1 Module initialization 

flag 

(PHASE PLANE 

IB 

|0,1 

1 none 

125 

1 

1 

i 

j ( 1=initialization) 
1 


1 

I 

_J 

1 

1 

[ 

1 

1 

1 

1IH1T JET SELECT 
1 

1 Module inirializazion 
1 (1=initializatiaii) 

flag 

[JET SELECT 
( 

IB 

I 

|0,1 

1 

_ _ 
{ noiio 

1 
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1 

I 

1 

J 
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1 _ 
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i 
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1 Module initia liza tion 
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[PABT1 FILTER 

IB 
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1 

1 
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J 


1 

1 

i 

I 
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1 

I 

P 

1 

—1 
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[Module initialization 

flag 
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1 
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1 
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1 


1 

_1 

1 

1 

_i 

1 

1 

1 

1 

UNIT OMS ENG CMD 

1 Module initialization 
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|B 
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1 
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i 
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1 

1 

J 

I 

I 

i 
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1 
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IS 
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1 
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J 
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IB 
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Table 4.2.1.4-1. Control law function module initialization conditions 


INITIALIZATION FLAG 

SET FLAG ON ENTRY INTO SPECIFIED MODE, 
SUBMODE, CONDITION 

INIT_AUT0_RCSJTRANS 

RCS translation auto 

init_two_axis_attitddb_maneuver 

RCS two- axis* 

IHIT THREE AXIS ATTITUDE MNVR 

RCS three- axis* 

INIT QMS PRETHRU5T MANEUVER 

RCS OMS-prethrust* 

INIT_ROT_PULSE 

RCS rotation manual pulse {by axis) 

INIT_TRANS_PULSE 

RCS translation manual pulse (by 
axis) 

IRIT ROT DISC 

RCS rotation manual discrete (each 


axis) 

INIT_ATTITUDE_LCL_VERTICAL 

RCS local-vertical* 

INIT_BARBEQUE 

RCS barbeque* 

IN IT_ATTITDDE_HOLD 

RCS rotation auto attitude-hold 

INIT__MANDAL_TVC 

TVC manual 

INIT_RCS_ERR0RS 

First pass/restart 

IN1T_PHASEJ?LANE 

RCS or TVC 

INIT_JET_SELECT 

RCS or TVC 

lNIT_PARTi_FII,TER 

First pass/restart 

INIT_GUIDANCE_COMPENSATION 

TVC auto 

INIT_OMS_ENG_CMD 

First pass/restart 

IHIT PITCH YAW ASSIST COMPUTATN 

TVC 

IHIT RCS ASSIST ROLL 

TVC 

INIT_RCS_AS SIST_PITCH_YAW 

TVC RCS-assist- roll-pitch-yaw 

init_tvc_law_roll 

TVC 

INIT TVC LAW PITCH YAW 

RCS OMS-prethrust* closed-loop-trim 


(flag=l) 


RCS OMS-prethrust* open-loop-trim or 
TVC fail-detect (flag=2) 


*These drivers may be called for display purposes without the necessity 
of performing the maneuver by enabling the rotation, automatic and 
attitude-maneuver submodes. Calling OMS_PRETHRUST_MANEUVER will cause 
CMS engine trimming in addition to generating display outputs. 


52 



4.2*2 Control Law Module 

Figure 4. 2. 2-1 is the major block diagram of the On-Orbit FC 
control lav/ module. This module contains 33 function modules which 
execute the control laws. On any given pass, the configuration of th.' 
control law module, i.e., nhe effective interconnection of the function 
modules, is determined by inputs from the supervisory module OFC__RECOK 
and from external sources including RM, MSC, D&C, EHC_READ and PANEL_ 
SWITCH_INTERP . 

Configuration control is implemented in four ways: 

1) By executing the particular function modules necessary to 
perform a given task in the sequence required. This function 
is performed by OPC_RECON and indicated in Figure 4. 2. 2-1 

by switches SI through S15, whose logic is described in 
Section 4. 2. 1.1. 

2) By passing initialization flags to the function modules which 
in turn initialize pass-to-pass storage elements such as 
filters, counters and integrators. All initialization flags 
are generated by OFC_RECON . 

3) By passing parameters defining quantitative behavior of 
certain function modules. These parameters include gains, 
magnitudes, thresholds and deadbands, and are supplied by 
OFC_RECON and external sources. 

4) By directly "forcing” certain variables. OPC_RECON does 
this when making major mode changes. 

The control law function modules are grouped into four categories; 
Drivers, RCS DAP, TVC DAP, and State Estimator. The general sequence of 
processing is: 

1) State Estimator, part 1 

2) Driver (s) 

3) DAP{s) 

4) State Estimator, part 2 

The State Estimator combines IMU attitude measurement data with 
extrapolations based on effector commands, to form a filtered estimate 
of the vehicle angular state. To reduce transport lag, the process is 
divided into two parts. Part 1 performs only those portions of the 
estimation function which are necessary to develop the effector commands. 
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These include incorporation of IMU data and development of vehicle 
angular rate and undesired angular acceleration data. Part 2 of the 
State Estimator performs the remainder of the estimation function, 
chiefly the extrapolations, after the DAP(s) have issued the effector 
commands , 

The Drivers convert a variety of input commands and data to forms 
acceptable by the respective DAPs. Reading from top to bottom in 
Figure 4. 2. 2-1, the 16 drivers are divided into the following types: 

1) 2 manual RGS translation 

2 ) 1 automatic RCS translation 

3) 7 automatic RGS rotation: attitude maneuver 

4) 1 automatic RGS rotation: attitude hold 

5) 3 manual RCS rotation 

6) 1 manual TVC 

7) 1 automatic TVC 

The RCS translation drivers generate commands for the jet selection 
module in the RCS DAP. The two manual RCS translation drivers process 
a single vehicle axis at a time, while the automatic RCS translation 
driver is a three-axis routine. 

Of the RCS rotation drivers, all but two generate commands for 
the RCS DAP error determination module; the remaining two (ROT_ACCEL_ 
and ROT PULSE) drive the jet se].ection routine directly. The seven 
attitude maneuver drivers additionally supply display data expressing 
desired vehicle attitude as IMU gimbal angles, and five of these provide 
a flag for display indicating completion of a maneuver. It is possible 
to display the outputs of any of the attitude maneuver drivers while 
actually controlling RCS rotation with attitude hold or manual RCS 
rotation drivers. All the automatic RCS rotation drivers operate on 
three vehicle axes. The manual RCS rotation drivers may be selected 
axis by axis. Two of these, ROT_ACCEL and ROT_PULSE, are in fact single- 
axis processors. ROT_DISC is somewhat hybrid, combining single-axis 
and three-axis attributes. It is basically a three-axis routine, since 
it must supply a complete set of desired IMU gimbal angle increments 
to the RCS DAP; however, it is operated such that any one, two or three 
axes can be processed while components about nonparticipating axes are 
zeroed. Although this causes spurious error components to be generated 
(assuming that ROT_ACCEL and/or ROT_PULSE are producing rotations about 
axes not using ROT_piSC) , these components are never acted upon since 
the phase plane switching logic reads the same variable, BYPASS, that 
ROT DISC does in determining which axes to process. 
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Each of the TVC drivers provides a three-axis body rate command to 
the TVC DAP. 

The RCS DAP consists of jet selection logic preceded by a "front 
end" for rotation only^ which obtains attitude and angular rate errors, 
and processes these through a phase plane switching logic that drives 
the vehicle into a limit cycle about the desired attitude and angular 
rate, Mo preprocessing is used for the translation commands, which 
come directly from the drivers to the jet selection logic; two rotation 
drivers also feed commands directly to the jet selection logic. In 
addition to producing the primary RCS DAP output — commands to the RCS 
jets — the jet selection logic also provides translational and rotational 
velocity change predictions for use respectively by TRANS_PULSE and 
part 2 of the State Estimator. During TVC operation, the ECS DAP may 
be called upon to assist the TVC DAP in controlling vehicle attitude. 

When this happens, error signals from the TVC DAP drive the phase plane 
switching logic, and thus the selected TVC driver is in control of 
both DAPs. 

The TVC DAP contains all the functions required for on-off and 
thrust vector control of the QMS engines , and provides extrapolation 
data to the State Estimator. When only one OMS engine is operating, 
the TVC DAP needs RCS DAP assistance for roll control, and may need 
it for pitch and yav7 control; the TVC DAP must then additionally supply 
error data to the RCS DAP and calculate whether or not RCS assistance 
is needed in pitch and yaw. Because pitch and yaw may be controlled 
differently from roll, the TVC law fxmction and the RCS assist error- 
determination function are each split into two modules to prevent 
execution of unnecessary code. 

The starting or trim orientations of the OMS engines are calculated 
and commanded both before an OMS burn and at the time of an engin'e 
failure during a two-engine burn. The one-engine trim value has each 
engine pointed to thrust through the vehicle eg, and the two- engine 
value has both engines parallel, with the total thrust through the eg. 

A third choice of trim exists after an OMS burn has taken place; the 
trim value stored in the TVC law function, which has had the benefit 
of thrust misalignment correction, can be used as the starting trim 
for the next burn. 
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The control law function modules are descrihed in Sections 
4.2, 2.1 through 4. 2. 2. 5. Within these sections, the modules are ordered 
alphanumerically by name. The groupings are as follows: 


Section 


Sub: 

ject 

4. 2. 2.1 

Driver modules 



4. 2. 2. 2 

RCS DAP modules 



4. 2, 2.3 

State Estimator 

modules 


4.2.2. 4 

TVC DAP modules 


♦ 

4. 2. 2. 5 

Service modules 

(referred 

to in Sections 4. 2. 2.1 


through 4 . 2 . 2 . 4 ) 






5X)U)0U?JEAM 


OEIGINAL PAGE IS 
OF POOR QTJALnY 


Figure 4. 2. 2-1. OFC contxol law module func 










6fc control law module functions. 
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4. 2. 2.1. Drivers 


4 . 2 . 2 . 1 . 1 ATTITUDE_HOLD 

A. Function : This module provides inputs to the RCS DAP to 

effect a three-axis attitude hold. The vehicle is held to 
the attitude it had at the time of selection of the attitude 
hold submode, and will return to that attitude if it has 

a nonzero angular rate when the selection is made. 

B. Block Diagram : Figure 4. 2. 2, 1,1-1 

G . Processing Rate : TBD 

D. Interface Requirements : Table 4. 2. 2. 1.1-1 

E . Constants : none 

P. Initialization Requirements : Table 4. 2. 2, 1,1-2 


peeceding page blank not PM® 
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Figure 442.2.1.1-1 


ATTITUDE HOLD 
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4. 2. 2. 1.2 ATTITUDE LCL VERTICAL 


A. Function ; This module provides inputs to the RCS DAP to 
maintain a specified body-axis vector aligned to the local 
vertical, with zero rotational rate about the specified 
vector . 

B. Block Diagram : Figure 4. 2. 2. 1.2-1 

C. Processing Rate : 5/6 Hz 

D. Interface Requirements : Table 4.2.2.1.2-1> 

E. Constants : Table 4. 2. 2. 1.2-2 

F. Initialization Requirements: Table 4. 2.2.1. 2-3 
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Figure 4. 2. 2.1. 2-1 


ATTITUDE LCL VERTICAL 
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4. 2. 2. 1.3 ADTO RCS TRJUaS 


A. Function ; Tliis module provides an input to the RCS DAP to 
achieve commanded translational velocity changes in three 
axes. The input command is assumed to differ from its 
value on the previous pass if and only if it is a new incre- 
ment; any number of such increments can be commanded in a 
given maneuver. A velocity error deadband is incorporated 
to prevent severe cycling. 

B. Block Diagram ; Figure 4. 2. 2. 1.3-1 

C. Processing Rate ; 25 Hz 

D. Interface Requirements ; Table 4, 2. 2. 1,3-1 

E. Constants ; Table 4. 2. 2. 1.3-2 

P. Initialization Requirements ; Table 4. 2. 2. 1.3-3 
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4, 2. 2. 1.4 AUTO TVC 


A. Function : This module provides an input to the TVC DAP to 

achieve a three-axis vehicle angular rate corresponding to 
a commanded angular rate in inertial coordinates , dxiring a 
TVC burn. 

B. Block Diagram : Figure 4. 2. 2. 1.4-1 

C. Processing Rate ; 2 Hz (tentative) 

D. Interface Requirements ; Table 4. 2. 2. 1.4-1 

E. Constants ; none 

P. Initialization Requirements ; none 
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4. 2. 2. 1.5 


BARBEQUE 


A. Function : This module provides drive signals to the RCS DAP 

to align a specified body vector to a commanded inertial 
vector and then rotate the vehicle about the body vector at 

a predetermined rate. Upon initialization, TWO_AXIS_ATTITUDE 
MANEUVER is called to perform the vector alignment maneuver. 
When the maneuver has proceeded to within a predetermined 
angular deadband of the terminal attitude, it is abandoned 
and the rate drive algorithms executed instead. Any maneuver 
rate components usable by the rate drive are thus preserved. 

A second initialization is used to implement the changeover. 

B. Block Diagram : Figure 4. 2. 2. 1.5-1 

C. Processing Rate : 5/6 Hz 

D. Interface Requirements : Table 4. 2. 2. 1.5-1 

E. Constants ; Table 4. 2. 2. 1.5-2 

P. Initialization Requirements ; Table 4. 2. 2, 1.5-3 
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IS 
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1 
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™i 

(AUTO GA EESXBED 

(Desired IHD ginbal angles 

[DSC, BABBEQUE 

IA(3)S 
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TABLE 4.2.2. 1.5-2 BABBEQUE COHSTAHTS 


1 

1 HA HE 

J 

1 

1 DESCBXPTIOH 

1 

1 

TYPE 1 VALUE 

1 

1 OMIT 

i 

1 

I 

i 


ITDAP 

1 Period of ECS dap cycle 

IS 

10.04 

1 s 

i 

1 

( 

i 

J _ . 

! 

1 

1 EEBIOJ>_BABBEQUE„CyCLE 

1 Period of EAEBSQOE cycle 

IS 

1 1.2 

Is 

1 

! . . . _ 

1 

\ 

1 

1 

L 

ibab to deg 

IBadians to degrees conversion factor 

IS 

1 100/pi 

1 none 

1 

J 

1 

1 

1 

1 





TABLE 4. 2.2. 1,5-3 BARBEQUE INIIIALiaATlOS BEQUIRIH2HT5 


I 

1 IHITIALI2E 08 THAHSlTIOH 
I FBOH 

1 

1 

1 IHimilZE OH TEAHSITIOH 
1 TO 

1 . 

1 

j VAEIABLE 

1 

1 1 

1 IKITIAL VALOE 1 

1 1 





;iHIT_BAfiBEQBE = OFF 

|IHIT_BAEBEQDE = 08 

1 8AIT„FdB_TifO_AXIS 

iOH 1 

1 

J 

1 

I 

_J 

1 

JFllP 

1 

1 1 

1 Ter* 1 

|HAIT_FOBJEWO_AriS = OK 
1 

|WAIT_FOR_T:i?0_aXIS = OFF 
1 

|AUTO_GA_BBSIRSD 

t ” ” 

1 GA„MAHtUVEi_?=‘?HJ13AL | 

1 1 

1 

i 

_J 

1 GA_DESIE3D 

|GA_KAN’='TJV3r„T-r P/KAL | 


i 1 


4 . 2 . 2 . 1 . 6 MANUAL_TVC 

A. Function: This module provides inputs to the TVC DAP to 

generate a three-axis vehicle angular rate corresponding in 
sense and, up to a limit and subject to the deadband de- 
scribed below, proportional in magnitude to the RHC deflec- 
tion, during a TVC burn. A movable deadband is incorporated 
to suppress manual jitter. 


B. Block Diagram : Figure 4, 2. 2. 1.6-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements ; Table 4. 2. 2. 1.6-1 

E. Constants : Table 4. 2. 2. 1.6-2 

F- Initialization Requirements; Table 4, 2. 2. 1.6-3 
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NOTES: 1. ARRAY OR VECTOR SUBSCRIPT n SHOULD BE TAKEN AS INDICATING 

THAT THE PROCESSING SHOWN IS FOR ONE ELEMENT. AND ALL 
THREE ELEMENTS ARE PROCESSED. 

2 . THE EFFECT OF THE PROCESSING SHOWN IS TO PI ACE A DEADBAND 
ABOUT RHC„ CENTERED ON THE VALUE OF RHCj, LAST RESPONDED TO. 


Figure 4. 2. 2.1. 6-1. MANUAL TVC. 









TABLE 4*2. 2. 1.6-1 KANOAL^TVC IHTERFACE HEQUIBEMENTS 
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1 
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IB 
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TABLE 4.2.2*1*6-2 BAKHAL TVC COHSTAKTS 


1 

1 HA HE 

1 

j DESCIilPTIOH 

1 

1 TYPE 

1 

1 

_i 

1 1 

VALUE 1 UNIT 1 






IPEGPGSAD 

(Gain; coenanded body rate divided by RHC 

IA(3) S 

JTflD 

1 (deg/s)/deg J 

I 

1 deflection 

1 

1 

I i 

1 

.1 - 

J 

_J 

1.... ^ i 

JDBSTXCK 

(Deadband; required hand controller deflection 

IAC3) S 

ITBD 

Ideq 1 

1 

1 _ _ 
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1. 

1 

1 

( 1 

|SL 

1 Bate comaand Unit 

1 A (3) S 

)TBD 

i deg/s 1 

J 

1 

1 

i 

t 1 
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CD 

o 


TABLE 4.2. 2. 1.6-3 MAHnAL_TTC IHITIALI2ATI0H fiEQDiaEHZBTS 


111 II 

i IHITIALIZB OS TBAHSIIIOS 1. IHIT1ALI2E 0« TBAHSITIOH | VARIABLE | INITIAL VALIJF | 

I FRCK I TO I I ] 


lIHIT_flASOAL TVC = OH | LAST_ACCEPTED VALUE 1 

J I J I J 


II» 1 T_HABDAL_TVC = OFF 



4. 2. 2. 1.7 MISC TRACKING 


A. Function; This module provides inputs to the RCS DAP to 
effect attitude control. The command inputs and the 
internal functions of the module are TED. 

B. Block Diagram ; TED 

C. Processing Rate : TBD 

D. Interface Requirements ; Table 4. 2. 2. 1.7-1 

E . Constants : TBD 

F . Initialization Requirements : TBD 



TABLE U.2.2,1.7-1 HISC_TBaCKIHG INTERFACE EEQBIBEMEMTS 
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J. 










tXapnts 

1 

1 

1 

1 

1 


i 

1 

1 

t 

1 

1 

ITSD 

IXED 

ISO? 


ITBD 

ITED 

ITBO 

ITBD 

1 

1 - - 

1 

1 




1 

I 

1 

16IHBAL AHSLES 
1 
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1 
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( 

\ 

1 

I 
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1 Desired IHU gisbal angle 
Jincresen'ts 

1 HCS 

1 

EBBOBS 
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Ideq 
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1 
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1 

1 

1 
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ITBD 
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J 

1 
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i 

_J 


1 
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i 

-JL_ _ „ 

1 
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.2.1.8 OMS P2ETHRUST MANEUVER 


A. Function ; This module provides the RCS DAP with inputs to 
align the expected OMS thrust direction with a desired direc- 
tion expressed as a unit vector in IMU stable member coordi- 
nates. It also supplies the TVC DAP with the position of the 
orbiter center of gravity (eg) relative to each OMS engine. 
Upon initialization, the module calculates the engine-to-cg 
vectors and the expected thrust vector for a one- or two- 
engine burn. The expected thrust vector is supplied as the 
vehicle-fixed pointing vector to TW0_AXIS_ATTITUDE_MANEUVER. 

B. Block Diagram ; Figure 4.2..2.1.8-1 

C. Processing Rate : 5/6 Hz 

D. Interface Requirements ; Table 4. 2. 2. 1,8-1 

E. Constants: Table 4. 2. 2. 1.8-2 


F. 


Initialization Requirements; Table 4.2. 2. 1,8-3 


tOMS_SELECT1 


VEHICLE CG 


IN!T_OMS_PRETHRUST. 

MANEUVER 


MAXDES1R„B0DYRATE 


POINTlNG_VECTOR. 

CMD 


[GIMBAL_ANGLES] 


IWOW 


EAUT0_GA_DESIRED] 


-9^ 


INITIALIZATION 
{TABLE 4.2.2.L8-3) 


s 


INJT_*nA;0_AXIS_ 
ATTtTUDE_MANEUVER 




BODY POINTING VECTOR 


TWO_AXIS_ATTITUDE. 
MANEUVER 
{SECTION 4.2.2,1.16) 


QMS PRETHRUST MANEUVER 


OMS1_CG, 

OMSZICG 


[GA_OESIRED] 


(DELTA_GAJ 


DES1RED_B0DY_RATE 


IQA_MANEUVER_TERMINAL) 


IAUT0_GA_DES1RED] 


MANEUVEH_COMPLETE 




Figure 4. 2. 2. 1-8-1. OMS_PRETHRUST_MANEUVER. 
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TABLE 4.2.2. 1.0-1 0HS_SHETHE0S'r_HA8EnVEB IBTSRfACE PFOUIBEHEilTS 


1 

1 

i 
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1 1 
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1 
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10,1 
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TABLE J*. 2. 2. 1.8-1 OHS_PBETHEnST_MAKEtIVEE IKTEPFACE EEQUISEHENTS 
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TABLE 4,2.2, 1.8-2 OHS_PBETHaOST_HABSUVEfl CONSTAHTS 
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TABLE 4,2. 2.1, 8-3 OaS_SfiETHEUST_HASEDVEH INITIALIZATTOH SEOniESHES .S 


XKITXALXZE OH lEAHSLIIOH 
FaOB 


IKIT_OaS_PBETURUSr_llAH£UVEB 
= OFF 


i 
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TO I 
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I 
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t 
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IHITIAL VfiLn? 
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I ( 

I I 
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I t 

I TIotE! 1 I 


Note 1: -unit {OHSljCG scalar {OMS_SELECTj^) + QMS2_CG scalar (0MS_EELECT2 J ) 


4. 2. 2. 1.9 PAYLOAD ATTITUDE 


A. Function : This module provides the RCS DAP with inputs 

to effect attitude control. The command inputs and the 
internal functions of the module are TBD. 

B . Block Diagram : TBD 

C. Processing Rate ; TBD 

D. Interface Requirements : Table 4. 2. 2. 1.9-1 

E. Constants ; TBD 

P . Initialization Requirements : TBD 
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4.2.2.1.10 ROT_ACCEL 

A. Function ; For each vehicle axis that is in the manual 
acceleration rotation submode, this module provides an 
input to the RCS DAP to generate a vehicle angular acceler- 
ation about that axis while the RHC is out of detent in that 
axis. The sense of the angular acceleration corresponds to 
the sense of the RHC deflection. When the RHC is in detent, 
vehicle rotation about the affected axis is free . 


B. Block Diagram ; Figure 4.2.2.1.10-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements : Table 4.2.2.1.10-1 

E. Constants ; none 

F. Initialization Requirements : none 
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ROT„ACCEL 





NOTE: Array cr vector subscript AXIS should be taken as indicating that the 
processing shown is for thet element specified by the present value of AXIS, 


Figure 4.2.2.1.10-1, ROT_ACCEL. 
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TABIE 4.2.2.1.10-1 BOT_ACCEL IHIEEFACE EEOniEEhESTS 
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1 P.ATF (H2) 
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'3.2.2.1.11 ROT DISC 


A. Function ; For each vehicle axis that is in the manual 
discrete rate rotation submode, this module provides inputs 
to the RCS DAP to generate a predetermined vehicle angular 
rate about that axis while the EHC is out of detent in that 
axis. The sense of the angular rate corresponds to the 
sense of the RHC deflection- When the RHC is in detent, 

an attitude hold is performed in the affected axis; the 
vehicle returns to the attitude it had at the instant the 
RHC went into detent. 

B. Block Diagram ; Figure 4.2.2.1.11-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements i Table 4,2.2.1.11-1 

E. Constants I Table 4.2.2.1.11-2 


F. 


Initialization Requirements i Table 4.2.2.1.11-3 
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<1^ 
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IGIMBAL„ANGLES1 
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IRHC_STATE] 


[DISC_RATE1 


INITIALIZATION 
[TABLE 4.2.2.1.1 1-^3)] 


BYPASS„ 
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note: 

ARRAY OR VECTOR SUBSCRIPT n SHOULD BETAKEN AS 
INDICATING THAT THE PROCESSING SHOWN IS FOR ONE ELEMENT, 
AND ALL THREE ELEMENTS ARE PROCESSED. 


Figure 4.2.2.1.11-1 


ROT DISC 
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TABIB 442«2* 1.11-1 aOT^BISC IH^SEFACE EEqOXFEKFNTS 
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TABM 1.in"2 SOT^DISC CONSTANTS 


1 

1 



1 

1 

DESCSIPIIOtt 


1 

t TYtF 

1 \ 

1 vfti-iiz t TtKxr 

1 

1 

J 



L_ 



1 

L J. 

1 


lIDJP 

i 



IPeriod of 

HCS Bfl-E cycle 


IS 

I0.C4 |s 

i J 

1 


to 

o\ 


TABLE 4*2*2.mi-3 ROT^DISC IKITIALIZATIOH REQUIFEHEMJTS 


j 1K14IXI.I2E OS laASSmOH 
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4.2.2.1.12 ROTJPOLSE 

Function ; For each vehicle axis that is in the manual pulse 
rotation submode, this module provides an input to the RCS 
DAP to generate a predetermined vehicle angular rate incre- 
ment about that axis for each time the RHC is moved out of 
detent in that axis. The sense of the angular rate incre- 
ment corresponds to the sense of the RHC deflection. When 
the RHC is in detent, the achieved rate is maintained about 
the affected axis. A rate error deadband is incorporated 
to prevent severe cycling. 

B. Block Diagram : Figure 4.2.2.1.12-1 

C. Processing Rate ; 25 Hz/axis 

D. Interface Reguirements ; Table 4.2.2.1.12-1 

E . Constants : none 

F. Initialization Requirements ; Table 4.2.2.1.12-2 
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NOTE*- 

array or vector subscript axis should be taken to indicate that 
THE PROGESSINQ SHOWN IS FOR THAT ELEMENT SPECIFIED BY THE PRESENT 
VALUE OF AXI& 


Figure 4.2.2.1.12-1. ROT_PULSE 
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TABLE 4.2,2.1.12-1 HOT^PBLSE IHTEHFACE fiEQUIBEHEHTS 
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' TABLE 4.2.2.1.12-2 ROX_POLSB INITIALIZATIOH EEQUIH FHSHtS 
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4.2.2.1.13 THEEE_AXIS_ATTITUDE_MaMEUVER 

A, Function: This module provides the RCS DAP with inputs to 

achieve a desired vehicle attitude, expressed as commanded 
IMU gimhal angles, through a single equivalent rotation. 
Calculations to determine the maneuver path, rate and 
duration are made once, upon initialization. Successive 
executions during the maneuver interval continue to define 
the maneuver path by updating the desired IMU gimbal 
angles and the desired angle increments per RCS DAP cycle. 
At the end of the maneuver interval, the module effects 
an attitude hold at the commanded IMU gimbal angles. 


B. Block Diagram : Figure 4,2.2.1.13-1 

C. Processing Rate : S/6 Hz 

D. Interface Requirements ; Table 4.2.2,1.13-1 

E. Constants : Table 4.2.2.1.13-2 

F. Initialization Requirements; Figure 4.2.2.1.13-2 
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TiBlE «, 2,2. 1.13-1 IHSEE_AXIS_ATTITUDE_»AHEUVEB IH2EBFACE BECniEEHEIITS 


1 

1 

1 

1 

1 

1 SODBCE OB 

1 

1 

1 

1 

1 

1 

1 

1 SAHPLE 

1 

1 

1 H&EE 

J DESCBXEIIOU 

1 DESTIHATXOH 

1 TYPE 

1 EAKGE 

1 UHIT 

1 PATH (HZ) 

1 

J 

J 

„J 

J 

1 

- I 

1 

1 

* 

ilnputs 

1 

1 

1 

.1 

1 

} 

1 

1 

1 

{HAXbESIB BODIBXIE 

(Desired Magnitude of body angular |DGC 

IS 

|0 to 5 

|deg/s 

1 1 /maneuver 

1 

1 

Irate in autonatic attitude 

1 

I 

1 

1 

1 

1 

1 

1 Maneuvers 

1 

I 

1 

1 

1 

1 

1 . 

J 

1 .. 

1 

1 

1 

1 _ 

t 

|Gi_COMHASDED 

ICoMManded terainal IHU ginbal 

(GUXD or DBC 

|At3)S 

1-100 < 

x( deg 

1 l/iaaneuver 

1 

I 

jangles 

1 

1 

i<= leo 

1 

! 

1 

1 .... 

!. - 


1 . 

1 

t _ 

t 

-1 

|IHU THEBE AXIS ATI- 

(Hadule initialization flag 

|OFC EEC OH 

IB 

10,1 

(none 

15/6 

1 

JIIEDB_HHTH 

1 

1 

1 

1 

1 

t 

1 

1 

1 

1 

JL 

I 

1 

\ 

— i 

IGIHBAL AEG IBS 

1 IHO giMbal angles 

(SOP 

1 A (3) S 

I-1B0 < 

xjdeg 

( 1/aaneuver 

1 

1 

1 

1 

1 

;<= 1B0 

1 

I 

1 

J 

1 


1 

1 

1 

1 

—I 

{AUTO GA SESIBBO 

|Sesiced-XSD ginbal angle 

(THEBE AXIS ATTITODE 

-|A(3)S 

1-180 < 

x[ deg 

|5/6 

1 

1 

1 

i 

1 

(HAEEOVEB 

1 . . 

1 

1 

|<= 180 

1 

I 

.1 

1 

1 

I 

)IEOE 

I . 

1 current tine 

(SOB 

IS 

|TBD 
J 

IS 

_ i 

|5/6 

1 


I Outputs 

1 

1. 

1 

I 

I - 

1 

1 

1 

1 

1 _ 

1 

1 

__1 

|GA DBSIBED 

1 Desired XBU ginbal angles 

IDGC, ECS EEBOBS 

|A(3)S 

|-180" '< 

X] deg 

15/6 

1 

1 

1 

1 

..1 

1 

1 - - 

1 

|<= 180 

I 

„ 

1 

1 

i 

1 DELTA GA 

(Desired IfiH ginbal attgle 

! HCS_EHEOES 

|A(3)S 

ITBD 

Ideg 

15/6 

1 

1 

jincrenents 

1 

1 

1 

1 

1 

1 

1 _ 

1 

1 

J 

1 

1 

1 

—1 

1 DESIEBD_ EODX„B ATE 

(Desired body angular rate 

(ECS, EBB CBS 

JV(31S 

[TBD 

1 den/s 

1 l/maneuver 

1 

1 

.1 ..._ . 

1 . 

JL 

j 

. i _ _ 

1 

I 

lAHTO GA DE5XSED 

(Desired IHD ginbal angles 

(DOC, 

|A(3JS 

1-180 < 

X 1 deg 

|5/6 

1 

1 

i 

(THHEE AXIS_ATTITODB 

-1 

|<= 180 

1 

1 

1 

J 

i 

1 

J 

1 ttAHEnVER 

...i 

1 

.1 

1 

1 

1 

i 

1 

— i 

IGA HAEBDVEB TEBHIBAL I Desired teXMlual IKtl giabal 

(DBC 

1 A (31 S 

1-180 < 

X 1 deg 

1 1/naneuvet 

1 

1 

(angles 

1 

1 

1<= 10C 

1 

1 

1 

1 

1 

1 ... _ 

1 

_JL _ 

. 1 ._ . . 

i„ _ 

_ i 

IHAVED7EB COHBLETE 

1 Flag signifying coipletion a£ 

IDGC 

IS 

|0,1 

1 none 

|5/6 

1 

f 

i maneuver 

1 

1 

1 

1 

1 

1 


J_ _ _ 

1 

.1 

J 

,_i_ 

_ _i — 

— i 



T1BI.E 4.2.2.1.13-2 IHHEE aXlS„aliITBDE MAUEUYEE COHSTMITS 








SELECT A, B OR C 
(SEE NOTE 61 


THREE AXIS ATTITUDE MANEUVER INITIAUZATION 


Figure 4.2.2.1.13-2. THSEEJkXIS JkOTlTDDEJdaHElTO 

(page 1 of 3) . 
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N0TE1 


cos <1>2 cos ^3 


C BSM = 


sink's 


-cos <S >2 ^3 '*1 

+ sin <p2 sin 4 >-\ 

cos 03 cos 0^ 


-sin 02 cos 03 


sin 02 sin 03 cos0i 

+ COS 02sin0j 


cos 02 sin 03 sin 0.J 

+ sin 02 cos 01 
-cos03sin0-j 

-sin 02 sin 03 sin 0i 
+ COS 02 cos 01 


NOTE 2 


C_CSM 


cos 0Q2 COS 033 
sin 0Q3 

-sin 032 <5^5 032 


-cos 0Q2 sin 033 cos 0 qi 
+ sin 032='" ^C1 
cos 033 COS0Q1 

sin 032 =*" ^C 3 ^G1 

+ cos0Q2Sin03i 


cos 032 ^*03 ^C1 

+ sin 002 cos 0Q1 

-COS0Q3 sin 031 

-sin 0Q2 sin 033 ?in 031 
+ CCS 002^=^01 

J 


NOTE 3 

U_Ri = U_PRlMEi SIGN(-R_A2_3) 
U_R2 = U^PRIMEj SIGN(R_Si 2J 
U_R 3 = U_FR1ME3 S1GN(R_S.i 3 I 


Ficrure 4.2.2.1.13-2. THREE_AXIS_ATTITUDE_MaHEtIVER initialization 

(page 2 of 3 ) , 
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PEBCEDING PAGE BIAKS NOT HEiMEO 


NOTE 4 


U_Ri = U_PRIME, SIGN(R_A^^gl 

U_R2 = U_PRIME2SIGN(R_S^2l 

U_B3 = U_PR1ME3SIGN(R_S2^) 


NOTES 

U_R^ = U_PRlME^ S]GN(-R_A^ 

U„R2 = U_PR1ME2SIGN(R_S^3) 

U_R3 = U_PRIME3 SIGN{R_S2 3) 

NOTE S 

A ^ {U_RTi > U_RT2) ' {U_RTi > U_RT3) 
B = (U_RT2 > U_RTi) • (U„RT2 > U_RT3) 
c = sn 


Figure 4.2^2.1.13-2. THKEE_AXIS_ATTITDDE_MANEUVER initiali'zation 

Cpage”3 of 3). 
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4.2.2.1.14 TRaNS_ACCEL 

Function ; For each vehicle axis, that is in the manual 
acceleration translation mode, this module provides inputs 
to the RCS DAP to generate a vehicle translational acceler- 
ation along that axis while the THC is out of detent in that 
axis. The sense of the translational acceleration corre- 
sponds to the sense of the THC deflection, When the THC 
is in detent, vehicle translation along the affected axis 
is free. 



j 
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AXIS 

■w... jepp Mnxpt 


tTRANS_JET_C!VlDI 

[Tf+C]' 




^'^AXIS ^ 

1 

TRANS_JET„CMD;s^;^,g 





TRANS_ACCEL 



NOTE: Array cr vector subscript AXIS should be taken to Indicate that the processing shown is 
for that element specified by the present value of AXIS. 


Figure 4.2.2.1.14-1. TEflNS_ACCEL. 
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4.2.2.1.15 TEANS_PUI<SE 

A. Function: For each vehicle axis that is in the manual pulse 

translation mode, this module provides inputs to the RCS DAP 

to generate a predetermined vehicle translational velocity- 

increment along -that axis for each time the THC is moved 

out of detent in that axis. The sense of the -translational 

* 

velocity increment corresponds to the sense of the THC 
deflection. When the THC is in detent, the achieved veloc“ 
ity along the affected axis is maintained. A velocity 
error deadband is incorporated to prevent severe cycling. 


B. Block Diagram : Figure 4.2.2.1.15-1 

C. Processing Rate : 25 Hz/axis 

D. Interface Reguirements : Table 4.2,2.1.15-1 

E. Constants : Table 4.2.2.1.15-2 

F. Initialization Requirements : Table 4.2.2,1.15-3 
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ihovm it tor tint alement jpttifled hy the pr«»nt mint of . AXIS. 


Figure 4.2.2.1.15-1 
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TABLE 4.2.2.1,15-2 THANS POLSE COHSTABTS 


i I fill 

I MAlfE ] DESCRIPTIOH J TYPE | VALUE | UHTT [ 

i I J J L 1 


jDB_VEL I velocity ceeoe deadband, by axis IA(3)s |TBD |f/s I 

J L ! J 1 I 


TABLE 4.2.2.1.15-3 TEAHS_PULSE INITIAL IKATIOH HEQUIHEHEHTS 


I - i 

INITIALIZE ON IRANSIIXON 1 INITIALIZE OK THAKSITIOK ( 
FEQH I TO I 

I 1 


INIT TSANS PULSE* (Alls) = 1 1H1T_TBAHS PULSES (AXIS) 

OPP [ 
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I 
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I I 

VARIABLE I initial VALUE 1 

I I 
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I I 
I I 
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I I 
Id I 


= ON|¥NO«S{AXIS) 
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I 

IVDESIEBDStAXIS) 

I 

tOLD THCS(AXIS) 

I : 









TWOJkXISJlTTITUDEJiaWEUVER 

Function ; This module provides the RCS DAP with inputs to 
achieve a desired vehicle pointing direction through a 
single rotation. The desired direction is expressed as a 
unit vector in IMU stable member coordinates to which a 
vehicle-fixed vector is to be aligned. No rotation is made 
about the vehicle-fixed vector. Upon initialization, the 
module computes the IMU gimbal angles resulting from the 
vector alignment, and supplies these as commanded IMU gimbal 
angles to THREE_AXIS_ATTITUDE_MANEUVER. 

Block Diagram ; Figure 4.2.2.1.16-1 

Processing Rate : 5/6 Hz 

Interface Requirements ; Table 4.2.2.1.16-1 
Constants : Table 4.2.2.1.16-2 

Initialization Requirements ; Figure 4.2.2.1.16-2 
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Figure 4 . 2 . 2 . 1. 16-1. TW0_AXIS_ATTITUDE_M21NEUVER. 
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. TWO AXIS ATTITUDE MANEUVER initialiaation (page 1 of 2) . 


Figure 4.2.2.1.16-2 
















NOTEl 


Figure 4. 
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NOTE 2 
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NOTE 3 
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2.2.1.16-2. T170_AXISJ1TTI5UDEJ4MIEDVER initialization (page 2 of 2) 
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4. 2. 2. 2 RCS DAP 


4 . 2 . 2 . 2 . 1 JET_SELECT 

A. Function ; This module generates jet firing cominands required 
to implement commanded translations and rotations. It also 
predicts the resulting velocity and angular rate increments. 
The module contains separate logic for external selection of 
either^ the nominal (main) or vernier jets, and takes into 
account any jet failures. The nominal- jet logic enables 
external selection of high or low acceleration levels in 
translation and rotation (except roll) independently, 
includes algorithms that fire jets to compensate for off- 
axis and translation/ rotation coupling, and allows external 
Selection of forward or aft jets to effect low-level rota- 
tions in pitch and yaw independently. This last option is 
to permit forward/aft RCS fuel use balancing. 


B. Block Diagram ; TBD 

C. Processing Rate ; 25 Hz 

D. Interface Requirements ; Table 4. 2. 2. 2. 1-1 

E. Constanta ; TBD 

F . Initialization Requirements ; TBD 
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4.2. 2. 2. 2 PHASE PLAME 


A. Function ; For each body axis requiring P.CS rotation control 
and not in the manual rotation acceleration or manual rota- 
tion pulse submode, this module determines whether an angu- 
lar rate change is needed and the sign of the desired rate 
change. The vehicle is driven into and held in a limit cycle 
about the desired attitude and attitude rate. The parametei’s 
of the limit cycle are selected to minimize a weighted com- 
bination of response time and RCS fuel use. The attitude 
deadband is selected externally, and the module takes into 
account the undesired vehicle angular acceleration — the sum 
of the disturbance and modelled undesired accelerations. 

B. Block Diagram : Figures 4. 2.2.2. 2-1 through 4. 2. 2. 2. 2-8; 

Tables 4. 2. 2. 2. 2-1 and 4. 2. 2. 2. 2-2. 

C. Processing Rate ; 25 Hz 

D. Interface Requirements ; Table 4. 2. 2, 2. 2-3 

E. Constants : Table 4. 2. 2. 2. 2-4 

F. Initialization Requirements : Table 4. 2, 2. 2. 2-5 

Note; PHASE_PLANE is in the process of redesign as of the publication 
date of this document. 
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ELEMENTS ARE PROCESSED. 

ROT„ 

JET_CMD„ (ROT_JET_CMDI 


FOljX)UT MUMH 


125 











Figure 4. 2. 2. 2. 2-3. SMAIiL ERROR BOUNDARIES. 
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Figure 4.2.2. 2.2-6 


Small error phase plane 
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Figure 4. 2. 2. 2. 2-7. LARGE ERROR LIMITS, 






CET 


REGION II 


JMION_HLJ_ 

REGION CL_I (TARGET_ARU'V^ 

COAST IV BOUNDARY 


OJe 


+ RL 


SMALL ERROR 



Figure 4. 2. 2. 2. 2-8. Large error phase plane. 



Table 4, 2. 2, 2. 2-1. Control actions in small error control regions. 


REGION 

CONTROL ACTION, X_D VALUE 

I 

Drive state to BOUNDARY 1 TO COAST, -1 

II 

Drive state to TARGET_DISTURB , -1 

III 

Drive state to zero rate, +1 

IV 

Drive state to BOUNDARY_IVJIO__COAST, +1 

HS_I 

If X D OLD = +1 (i.e. , if coining from LARGE ERROR 
CONTROL_LOGIC or REGION_III) then Command +1 until 
zero rate is achieved, else Command 0. 

HS II 

If X D OLD = -1 (i.e., if coming from LARGE ERROR 


CONTROL_LOGIC or EEGION_II) then Command -1 until 
TARGET DISTURB is reached, else Command 0. 

CS_I 

Coast, 0 

CSII 

Coast, 0 



Table 4. 2. 2. 2. 2-2. Control actions in large error control regions. 


REGION 

CONTROL ACTION, X_D VALUE 

I 

Drive state to - (TARGET_ARL) , -1 

II 

Drive state to TARGET_ARL, -1 

III 

Drive state to COAST_IV__bOUNDAEY, +1 

IV 

Drive state to -RL, +1 

HL_I 

If X_D_OLD = -1 (i.e., if coming from Region II) 


then Command -1 until TARGET_ARL is reached, else 


Command 0. 

HL_II 

IF X DjDLD = -1 (i.e., if coming from Region I) 


then Command -1 until - (TARGET^ARL) is reached. 


else Command 0. 

CL_I 

Coast, 0 

CL II 

Coast , 0 
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TABLE 4.2. 2. 2.2-3 PHASE_PLAHE IHTEHFACE KEQniEEHEHTS 


1 

1 

1 

1 

1 

1 SOOBCE OB 

J 

1 

I 

1 

1 

1 

1 

( SAMPLE 

i 

1 

t MAflB 

J 

J BESCRIPTIOH 

1 DESTIHATIOH 

. 1 .. 

( TYPE 
.1 

( BAHGE 

1 UHIT 

1 BATE (HZ) 

1 

1 

1 


(Inputs 

1 

1 

1 

1 

i 

1 

1 

1 - - 

- 1 . - - 

1 - ... - 


f 

1 

( 

I 

(BTFASS 

) Hon-executlon cousand, b; axis 

(OFC BECOH 

(A{3)B 

10,1 

1 none 

1 2S 

! 

1 

1 

1 (1=do not execute; 0=execute] 

. 1 

1 

1 


( 

) 

1 

1 

1 

(AITITDDE EEHOE 

(Body angle ercor 

(Boll Couponent; 

|V(3)S 

(TBD 

|deg 

"(25 

I 

1 

1 

(BCS ESBOBS or 

1 

1 

1 

t 

1 

1 


(BCS ASSIST BOLL 

1 

1 

J 

I 

1 

( 

1 

(Pitcb and yaw 

1 

1 

1 

! 

1 

1 

I 

(CQiponents; 

1 

i 

1 

1 

1 

t 

1 

(BCS liBBOBS or 

1 

1 

1 

1 

1 

1 

1 

(BCS_ASSIST PITCH YAH 

( 

I 

1 

1 

i 

1 


.1 


( 

_J 


__i 

(EATE EBBOB 

(Body angulai; rate error 

(Boll couponent: 

(V(3)S 

(TBD 

[deg/s 

[25 

1 

( 

1 

(BCS EBBOBS or 

1 

1 

1 

! 

1 


1 

(BCS ASSIST BOLL 

1 


1 

1 

1 

I 

1 

(Pitch and yaw 

1 

1 

1 

1 

1 

1 

1 

(coaponents: 

1 

1 

1 

1 

1 

1 

1 

(SCS_EEBOES or 

1 

i 

1 

1 

1 

1 

1 

( .. . . 

(BCS_ASSIST PITCH YAH 

-1 - 

1 

1 

1 

1 

1 

(DKBESXBED ACCEL 

(Total undesired body angular 

(PAHT1 FIlTEfi 

(V(3)S 

|TBU 

|deg/((s) ts) ) 

(25 

! 

I 

j acceleration 

1 

1 

1 

1 

1 

i 

1 

.. 1 . _ . . _ 

1 

1 

1 


1 _ . 

-_1 

(DEADBAHD 

(Attitude deadband 

(PAMBL SHIICH IHTEEP 

1 A C3) 5 

(TBD 

(deg 

(25 

t 

1 

1_ 

1 

1 



.L . ._ 

1 

JEOT_JBT_CHB 

(Botation counand froit preTlous 

(PHiSE_PLAHE» 

(M3) I 

i-vo,i 

1 none 

[25 

1 

1 

(cycle 

(EOT ACCEL, EOT PULSE 

( 

1 

t 

( 

1 

1 

1 

(or OPC_EECOH 

1 

1 

1 

1 

1 


..,,1 ■ ■ , ■ ■ ■ 

1 

t 

_ 1 

{ 

1 

1 

J I HlT_pa A SE_P1 A H E 

i Bo du 1 e in itia 1 iza tion ■ f lag 

( 0FC_BEC0H 

|B 

|0,1 

(none 

125 

i 

1 


1 Outputs 

1 

( 

1 

1 

J _ 

I 

.J 

( 

1 

1 

1 

_ 1 

|B0T_JET_C11D 
J 

( Botation conuand 
1 

(JET SELECT 

._i 

(A (3) I 


1 none 
1 

125 

1 
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TABLE 4.2,2t2.2-4 PHA3E_PLAH£ COHSTAHTS 


1 

[ HA HE 

1 _ 

1 

t DESCfilPIION 


1 

1 TYPE 



I 

1 

L 


|CD 

JS HITCH CDRVE DESIGN PAEAMETEfi 


IS 

10.8 

I HONE 

[ 

1 

. 1 . - - 


t 

\ 

I 

i 

ICOAST_l BOOHDAEy 

1 

{Bat& error boundary of lower coasting region 
1 large error phase plane 

Of 

IS 

; 

1-3.0 

1 

I deq/s 
I 

1 

1 

1 

) . 


_ i _ __ 

J 


i 

1 COAST 'iV BCUHDAEIt 

ISate error boundary of upper coasting region 

Of 

IS 

iCOAST_I_BOtIHDAB Y | deg/s 

1 

1 

j large error phase plane 


1 

-i 

1 

.1 _ 

I 

1 

- 1 

IK DB 

1 Fraction cf deadband to be used for “ledges" 


IS 

10.2 

(none 

1 

i 

1 

1 (deltas (DB) in saall error phase plane] - 
1 


i 

1 

1 

1 

t 

fK 13 

.1 

jLioit cycle design paraneter 

1 - ... - 


IS 

.1 

t 1.0/3. 0 

I, _ .. 

1 none 

1 

L 

|HL 

IRate error boundary between large and stnall 


IS 

|4.0 

1 a eg/s 

1 

1 

1 

(error phase planes 


1 

I 

j 

1 

i 

fTABGET AEL 

(Target average rate linit inside large and small (S 

I (COAST_I_BOUKnAPY|deq/s 

1 

1 

t 

(error phase plane coast region 


1 

-i__ _ 

|+ BL) / 2.0 
-i ^ 

1 

1 

1 

JCOHTBOL ACCELEBAT10H_HAGNII 

-( Magnitude cf available control acceleration 

for 

lA (3)S 

ITBD 

!deg/( (s] (s)) 1 

lUDE 

1 _ 

(each axis 


i 

I 

I . 

1 

1 

L 


TABLE 4. 2. 2. 2. 2-5 PHASE_ELAHE IHITIALIZATION 

EEQtllEEaEHTS 




I 

1 IHITIALIZB OE TBABSIIIOH 

i 1 

1 INITIALIZE OH lEAHSITIOH | 

VARIABLE 

I 

I 

INITIAL VAIMT 

1 

1 

1 FBCH 

i TO ( 



I 


1 


IIHIT PHASE_BLAHE = OFF 
1 

j INIT_PHASE_PLAHE = OH |BOT_JET_CHD 



I 0 


1 

1 



4. 2. 2. 2. 3 


RCS_ERRORS 

A. Function ; This module obtains the vehicle attitude and 
angular rate errors, based upon commands from the attitude 
drivers and measurement data from the IMU and the State 
Estimator. It also performs the incrementation required to 
interface position commands from the attitude drivers, some 
of which operate at 5/6 Ha, to the RCS DAP rate of 25 Ha. 
The desired gimbal angles are updated by the smoothing 
increment and the result subtracted from the actual gimbal 
angles. The remainder is the gimbal angle error, which 

is converted to body coordinates to yield body angle or 
attitude error. The angular rate error is obtained as the 
difference between the estimated and desired body rates. 

B. Block Diagram ; Figure 4. 2. 2. 2. 3-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements : Table 4. 2. 2. 2. 3-1 

E - Constants : none 

F. Initialization Requirements : Table 4. 2. 2. 2. 3-2 
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Figure 4. 2. 2. 2.3-1. RCS ERRORS 





T4BLE 4.2, 2. 2. 3-1 ECS_EEBOES XHTBBFaCE HEQUIREHEMT5 





Inputs 

GA~DESIHBD 


DEm„G& 


DBSlRED_BODr„RlTE 


SIBBAL_ASGIES 


OESCHIPTIOU 


SOHBCE OR 
DESTIHATIOR 


Desired IHO gintal angles 


i 


|ATTITDDE_HOLD, 

1 ATTITUDE LCL_YERTICA- 
II, BABBEQUE, 
|H1SC_TBACKIHG, 

J Ons^PaETHHUST_BAWED V- 
1 £H,’'eAT1QAD_SUPPLIED_ 
I CUDS, EOT DISC, 

1 THEEE_AIIS_iTTITUDE_- 
IMAHBDVEB, or 
)T«0 AXIS 

1 attitudeIhaheoveb or 
IBC5 EBE0B5 

J 


Desired IBD glxDal angle 
increments 


Desired body angular rate 


lATTITDDE_dOLD, 

} ATIITDDE_LCL_VEETICA- 
|L, BABBEQUE, 
iHISC TBACKXBG, 

I OMS_iEETHBUST_KAHEnV- 
ISE, PAI10AD_SUPBI,IED_ 
iCKDS, B0T_DISC, 

\ THBEE^A XI S_ATTITODE_- 
JHAHEDVEfl, or 
(TBO AXIS ATTITUDE MA- 
I HEUTEB 

.L 


IHU giabal angles 


I ATTIIUD BEHOLD, 

] ATTITUD£_I.C:i_VEETICA“ 
|L, BABBEQUE, 

IHISC TEACKIHG, 
lOMS^PBETHEOST HAHEUV- 
lER, PATLOAD SUPP11SD_ 
ICHDS, BOT_DISC, 
|THEEE_AXIS ATTITUDE - 
IHAHEUVEE, or 
( TBO_AXIS_ATTITUDS_HA- 
I HBUVEB 

J. 1 


I SOP 


TTPE 


A{3)S 


A(3)S 


V(3)S 


A (3) 5 


FAHGE 


-180 < X 
<= 180 


TBD 


TBD 


-180 < X 
<= 180 


UHIT 


deg 


deg 


deg/s 


J 

deg 


SAHPLE 
FATF (Uaj 




25 


25 


—1 


25 




-_L 

125 
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IIBIB 4. 2. 2. 2. 3-1 ECS_EEflORS iHTEaFiCE BEQCIESttEHTS 


1 

1 

C 

1 

1 

1 SOOBCE OR 

1 

f 

1 

1 

1 

( 

1 1 

1 SABFLE t 

1 HA BE 

J 

i BESCBIPTIOH 

1 

1 oestisation 

1 

1 TXPE 
J 

t EA3GE 
_J 

( USIT 

1 

1 FATE (HZ) 1 


IB ATE ESX 

IBody angular rate estlmte 

1 PARTI FILTER 

IV (3) S 

|TBD 

|deg/s 

125 1 

4 

1 

. 1 

1 

- j - 

J 

_1 

|IK1T_HCS_EBH0HS 

IHodule initialization flag 
i 

|DFC RECOH 

IB 

10,1 
- 1 

1 none 

125 1 

I 1 


lOatputs 

1 

1 

1 

1 

1 

1 1 

i 

1 


J 

_ 1 _ 

_J 

1 L 


|li:TITODE_EHBDfi i Body angle error ( PHASE_PL1HE |V(3)S |TBD | deg (25 1 

tBATE_EEHO& iBody angular rate error | D&C, ''phASB_PI.AHE i^JTs JTBD |deq/i 125 I 


IGA DESIRED 

(Desired IHD giabal angles 

1 DEC, BCS ERRORS, U(3}S 

|-1S0 < x|deg 125 

1 

1 

1 

(ATTITUDE ICL TEETICA- | 

l<= 180 t 1 

1 

1 

1 

|L, BARBEQUE, BOT_DISC 1 

1 1 1 

1 

1 

J 

1 T 

1 1 ! 



TABLE 4. 2.2. 2. 3-2 HCS_Ea80SS IMITIALIZATIOH HEQUIBEHENTS 


t 

1 IHITIILIZE OH TRAHSITIOH 
1 EBCH 

! .. 

1 

1 IHITIALIZE OH TRAHSITIOH 
1 TO 

J 

1 

1 VARIABLE 

1 

J 

1 

( IHITIAL VALUF 

1 


11 SIT RCS_EEBORS = OFF 
J 

IlKIT HCS_EBSaHS * OH 

_l_ 

1 OLD_GA„FLIP_SIGH 

|TBD 



OKIGjl^AL PAGE IS 
OP POOH QUAIZrSi 


i 


Figure 4. 2. 2. 2. 3-1. PART1_FILTER. 
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«, 2, 2. 3.1-1 PAEri_FILTJR IHTSEFACE SEQUIEEHEHTS 


1 

1 

i 

1 

1 

1 SOOECE OE 

1 

1 

1 

I 

1 

1 

I 

1 SSKPIE 

1 

1 

i D&HE 

J .... 

1 DESCaXEXIOE 

J 

1 DESriHAXIOE 

_L 

1 TYPE 
i 

1 RANGE 

) DNIT 

1 EATF (HZ) 

1 

1 


jiopats 

1 

1 

t 

1 

1 

1 

1 

1 

1 _ 

1 

1 

J. 

tGIESBAI. iHGLBS 

|IEG giabdl angles 

1 

1 - 

(SOP 

|A(3JS 

(“180 < 

X|deg 

125 

1 

1 

1 

1 

1 . _ 

I 

f . . 

|<= 18G 

1 

. 1 .. 

1 

.1 

1 

1 

IGIHBAL AXGLBS GLO 

IIBO giibal angles fcon previous 

1PAHX2 FILTER 

1 A(3JS 

(-180 < 

x(deq 

125 

1 

1 

1 

i cycle 

1 .. . . 

1 

) 

1 

J 

(<= 180 

1 

1 

_L.. 

1 

i 

ISXXR&P ATTlTaOB E5S1 

1 Extrapolated filter 1 body angle 

(P&ET2 FILTER 

|VC3)S 

(-180 < 

X 1 deg 

125 

1 

1 

1 

1 estivate iron previous cycle 

1 

1 

1 

t 

_L 

(<= 1BC 
I 

t 

1 

1 

1 

|BXTEiE„HATE_ES T1 
1 

{Extrapolated filter 1 body 
I angular rate estiaate iron 

(PAET2 FILTER 
t 

|V(3)S 

1 

(TBt) 

1 

1 deq/s 

1 

125 

1 

1 

1 

t 

i 

I previous cvrio, 
I 

1 

1 

1 

1 

1 

! 

1 

1 

i 

IDISTOSB iCCEL 2S1 0- 

I Body angular disturbance 

(PABT2 FIITEE 

|VC3)S 

)TBD 

]deg/((sl (s) ) 

125 

1 

lit) 

i deceleration estinate iron 

( 

1 

1 

1 

[ 

1 

1 

i previous cycle 

i 

1 

J 

1 

! 

1 

1 

I 

1 

1 

1 

1 

.1 

_ 1 

IHODEILED ACCEL 

I modelled undesired body angular 

(PART 2 FILTER 

|V{3)S 

(TPD 

|deg/((s) (s) ) 

125 

1 

1 

1 acceleration fxon previous cycle 

i 

1 

1 

1 

1 

1 

1 

1 . _ 

1 - 

1 

1 

i 

I 

_i 

I40:n:iIDDE_GAIH1 

) Filter 1 gain for attitude tern 

1 OFC^RECOR 

IS 

(TBD 

1 none 

125 

1 

I 

.1 

1 

1 

1 

1 

\ 

-1 

|AISIIUDB_GAIK2 

! 

(Filter 2 gain for attitude tera 
1 

(GFC SECOH 

1 .. 

IS 

(TBD 

1 none 

125 

1 

i 

IBATB^GAIHI 

1 

1 Filter 1 gaih for rate tern 

1 . 

(OFC EEC OH 
1 

IS 

1 _ 

(TED 

J 

j none 

1_ ._ .. ... 

125 

1 

|EATB_GAIK2 
i . 

(Filter 2 gain for rate tern 
f 

|0FC_BEC0H 

i 

(S 

ITBD 

(none 

125 

1 

_ i 

lACCEL^GAZH 

(Filter 2 gain for acceleration 

(OFC RECOH 

IS 

|TDD 

1 none 

125 

1 

1 

1 

1 tern ) 

1 

) 

1 

1 

,_i _ 

I 

1 

|iai3C PAET1_FIIIEB 

(Hodule initialization flag 

[OFC EEC OH 

ID 

(0,1 

[ none 

(25 

1 

1 

1 

(... _ ... 

. 1 


. 1 __ 

I 

_ 1 

lEXTHAS ATIITODE ESI2 

(Extrapolated filter 2 body angle 

1PABT2 FILTEH 

1 V{3)S 

(-181 < 

x( deg 

125 

I 

1 

! 

1 estinate fron previous cycle 

1 

1 

J 

1 

(<= 180 

1 

■_i - 

1 

1 

— 1 

IBITEAE BAXB„EST2 

(Extrapolated filter 2 body 

(PAET2 FILTER 

1 V(3)S 

|TBB 

1 deg/5 

125 

1 

1 

1 

(angular rate estinate fron 
(previous cycle 

1 

1 

1 

( 

1 

1 

I 

1 

1 

1 

1 

i 
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TABLE it. 2,2,3. 1-1 PAET1_FILTEfl IHTEEFACE bEQOIFEMEHTS 


1 

1 

1 HA HE 

1 

i 

( DESCBIETIOH 

1 

1 SOUECE OB 

1 DESTINATIOH 

1 

1 

j .jYpf 

. r . 

I 

1 

1 PAHGS 

1 

1 

1 ilHII 

1 

1 

1 F^.V^L'" 

1 ?a:s tf2) 
1 

1 

1 

1 

1 


(Outputs 

! 

i 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 


J ATTITUDE EST1 

(Filter 1 body angle estiuate 

(PARTI-FILTER 

!V(3)S 

(-ih; < 

x| deg 

UE 

1 

1 

i 

( 

1 

1 

1 

1 

. i 

)<= ia: 
1 

1 

1 

1 

t 

1 

I 

(HATE EST 

(Filter 1 body angular rate 

(Dec, PAET2 FILTEE, 

IV (3) 5 

[TBD 

1 dea /s 

(25 

1 

1 

( estinate 

(ECS_EEHOES, EOT PULSE | 

1 

1 

1 

1 


) 

(Boll component: 

1 

1 

1 

I 

1 

1 

1 

(RCS_ASSIST„ROLL 

( 

1 

1 

1 

1 

I 

1 

JPitcJt and yau 

1 

1 

1 


1 

1 

( 

(coaponents: 

1 

1 

1 

1 

1 

1 

1 

(RCS_ASSIST PITCH 2AH, ( 

1 

1 

1 

1 

1 

( 

(PITCH YAH ASSIST COH- | 

! 

1 

1 

1 

1 

[ 

(POTATIOH 

1 

1 

1 

1 

) 

1 

1 

1 


J_ _ 

1 

1 

X 

|UHDESIHED_ ACCEL 

(Total uudesired body angular 

(PHASE PLAHE, 



)V{3)S 

|TPD 

(deg/( [s) (s) ) 

1 2 S 

1 


{ acceleration 

|PAET2_FILTBr. 

1 

1 

1 

1 

i 

J 

1 

1 

1 

1 

1 

-t 

i 

|DISTDEB_ACCBL ESX 

(Body angular disturbance 

(PAHT2 FILTEB Soli 

1 V(3)S 

)TBt' 

[dec/ ((S] (s) } 

|2-=^ 

1 

I 

1 _ 

1 acceleration ' estiaate 
1 

(coaponent; BH 
t 

! 

„i 

1 

1 

1 

1 

1 

1 

(ATTITUDE EST2 

(Filter 2 body angle estiaates 

(PAET2 FIITE? 

|V(3)S 

i-ie; < 

X I deq 

(25 

1 

[ 

1 

1 

1 

1 

1 

(<= IE', 
1 

! 

1 

1 

1 

I 

f 

(BATE EST2 

(Filter 2 body angular rate 

(PART2 FILTEP 

1V(3)£ 

(ipr- 

1 de^/s 

!2‘‘' 

) 

[ 

1 estiaate 

1 

1 

1 

1 

1 

1 


_JL_ - _ 

■ J 

-i 

i . 

■U,. 

-1 ___ 
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lABLE 4.2.3. 1-2 PSaHI FILTEE COHSTaWTS 


I ■ 1 “ “ I t ■■ i " " T 

I HA BE I DESCEIPTION | TYPE t VAIUE | UNIT | 

J 1 I 1 1 i 


ITDAP J Period of state estiaatot cycle |S 1 0.04 |s | 

i \ j 1 1 1 


TABLE 4. 2. 2. 3. 1-3 PABT1_FILTEE IHITIALIZATIOH EEQDIEE BESTS 


1 

( IHITIALiaB OH THAHSITIOH 
1 FBOB 

J 

I 

t IKITIALIZE OH TEAHSITIOH 
1 TO 

_J 

1 

1 7AEIABLE 

J 

1 

I laiTlAt VALOF 

1 

1 

1 

1 

1 


IIHIT_PaET1_PILTBfi = OFF 

|IHir_PiETl_FILTBB = 0» 

i GIHB AL_A NGIE S„01D 

IGIKBAL^ANGLES 

1 

1 

1 

1 

« 

ilTTIItJDE 

1 

!0 

1 

! 

i 

I 


( B2TEAP_ATTITnDE_EST1 

1 

10 

i 

t 

1 

1 

1 

. 1 

1 

lEXTSAP„ATTITnDE_£5T2 

1 

10 

\ 

1 

1 

1 

1 

1 

IEXTEAP_EATE„EST1 

1 

|C 

1 

I 

1 

1 

1 

! 

|EXTEAP_EATE_ESr2 

1 

10 

1 

1 

1 

1 

.1 

1 D1STUEB_ACCEL_EST_0LD 

1 

|C 

1 

1 

i 

1 

t 

J 

1 

1 

1 

Jl 

t 

|ElSTBfiB_ACCEL_EST for previous 9 
1 (stored in "average of 10 passes 
1 

1 

passes 1 0 

" function) f 

1 

1 

1 

L 


4. 2. 2. 3. 2 


PART2_FILTER 

A. Function : This module extrapolates the vehicle state for 

the next FC cycle as a function of the estimated present 
state and the expected angular rate changes due to control 
effector use; it also models angular acceleration. It first 
computes the extrapolated angular rate increment as the sum 
of the control-effector and undesired-acceleration rate 
increments. This rate increment is then filtered with 
attitude and angular rate estimates in two parallel filters 
(a "rate" filter and an "acceleration" filter) to obtain 
attitude and angular rate extrapolations. Angular acceler- 
ation modelling is TBD. 

B. Block Diagram : Figure 4. 2. 2. 3. 2-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements ; Table 4. 2. 2. 3. 2-1 

E. Constants : Table 4. 2. 2. 3. 2-2 

F. Initialization Reguirements : none 
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EXTRAP_RATE_ 
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EXTRAP_ 

, AVERAGE , 
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atthtIde 
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1KCREMEMT1 

^ MODULAR ADD 1 
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) — 1 


j_ ISECTION 4.2.2.5.2J _[ 


EXTRAP* 

AVlRAGE. 


EXTRAP* 

. ATTI'riJDE* 

1 INCREMENTS 



\ RATE2 1 

TOAP 

1 *1 
I MODULAR ADD 1 



1 ! ISECTION 4.S.2.BJI I ^ 
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PAnTa_FILT£R 
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EXrRAP_BATE_EST) 
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MODEUEO ACCEL 


Figure 4. 2. 2. 3. 2-1. PART2_FILTER 
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TABLE 4. 2, 2, 3. 2-1 PaET2_FlLTEH IHTEBFRCT: PE08IBEHFNTS 


1 

t 

1 

1 

1 

1 

SOOHCE OR 

1 

1 

1 

1 

1 

1 

1 

1 

S.A 

1 

KPLE 1 

1 BAKE 

( DESCRIETIOH 

1 

DZSTIHATIOH 

1 TYtr 
i 

( lAMGE 

1 UNIT 

1 

1 ^ 
1 

iT 

- (HZ) 1 


(Inputs 

1 

1 


1 

( 

1 

1 


1 

l_ 

1 . _ 

_J _ 


. ..i ... 

J 

.. i _ 

i 


1 

lATTlTDDE^BSTl 

(Filter 1 boSy angle estiaate 

( PAET1 

FILISi 

|7(3)S 

1-16] < 

X ( den 

U5 


1 

1 

1 

1 


1 

(<= 160 

) 

1 


1 

I.. . .. - 

1 

.1 - 


1 

„J __ 

1 . . 

1 


i 

(BATE EST 

{ Filter 1 body angular rate 

( EAET1 

_FIL-XEB 

|V(3}S 

(TBO 

1 dea/s 

125 


1 

1 

1 

(estinate 

1 

-i _ 


1 

! 

_i 

1 

I 

t 

i _ 


1 

i 

(ATTITUDE EST2 

(Filter 2 body angle estinate 

I PABT1 

.FILTER 

|V(3)S 

i-ia: < 

X|deo 

125 


1 

1 

l_ _ 

1 

1 

I 

I 


1 

(<= 18C 

1 

1 

1 


1 

_1 

(BATE EST2 

(Filter 2 body angular rate 

(PABT1 

_FILXEI 

1 V(3)S 

iTPD 

1 den/s 

125 


1 

1 

1 

1 estinate 

1 - 

( 


( 

1 

1 

_i _. .. . 

t 

i _ 


1 

(UBDESIflED ACCEL 

(Total nndesired body angular 

( PAET1 

.FILTER 

IV (31 S 

(TBD 

1 deg/ [ (s( (s) 1 

(25 


1 

1 

( 

(acceleration 

» .. . 

1 

-i _ 


1 

1 

1 

1 

1 

i 


1 

1 

( DISTUB B ACCEL ESX 

(Body angular disturbance 

( PASTI 

.FILTBP, 

(V(3)S 

_ 

(TBD 

Idea/ ((s} (sn 

125 


1 

( 

(acceleration estivate 

1 


1 

1 

1 

1 


1 

1 . _ _ 

1 

_! 


1 

1 

1 



.. 1 

(DELTA OKEGA OKS 

(Hcdelled body angular rate 

1 DELTA 

OKEGA OKS SBGI-1V{3)S 

(TBP 

1 deo/s 

125 


1 

1 

jincreient due to QHS TFC 

(BE or 

PABT2.F1LTEE 

1 

1 

1 

1 


1 

f _ 

1 

_J 


. .1 

. 1 . 

L .. _ . . 

i 


.L 

(DELTA OHBGA BCS 

1 Kodelied 'lody angnlar rate 

(JET„SELECT or 

(Vt3)S 

(TBD 

1 deg/s 

125 


1 

1 

i 

(increaent due to BCS jet firings 

1 

(PAET2 

.FILTE.-, 

1 

1 

1 

1 

1 .._ 

1 

i _ 


! 

1 

(GIBBAL AKGIES 

(IHO ginbal angles 

(SOP 


(A(3)5 

1-ib; < 

X 1 deq 

125 


1 

1 

i 

( 

1- 

( 

1 


1 

i_ 

l<- 18C 

1 

1 

1 

i 


1 

i 


(Outputs 

1 

1 


( 

l 

1 

1 


1 

1 

I - 

-i _ 


1 

... 1 

. 1 . .. ... _. ... 

_i 


i 

(EXTBAP ATTITUDE ESTI 

(Extrapolated filter 1 body angle 
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.FILTFP 

|V(3)S 
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1 

1 

I estinate 
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1 
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1 

1 


1 

1 

i 
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i 
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IV (3) S 
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1 deq/s 
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1 

1 

1 
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1 

-i _ 


1 
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1 

1 

1 
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1 

-i 
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! 
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I 

1 
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1 

1 


1 
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TiBlE «. 2. 2, 3. 2-1 PiaT2_FII.TEB IHTEEPACE EEQOIBEK EHTS 


1 

1 

1 

1 

1 

! SOUBCB OB 

1 

1 

1 t 

i 1 

I 

t SABPLE 

1 

( 

1 SAaK 

J 

1 DESCaiPTIOU 

1 DESTIHATIoa 

1 TYPE 
J 

1 PAUGF 1 OlIIT 

1 ?AT“ {H7) 
i 

t 

1 

- 

laODELtlD ACCEL 

laodelled undesiced body angulai; 

IPAET1 FILTER 

1V(31S 

ITBD |deg/((s) (s) 1 

125 

1 

1 

J 

iaccelecatlon 

1 

..1 

1 

1 

1 i 

1 

1 

i 

lBITEAP_a!rrrrnDE_ES12|EKtrapolatea filtec 2 body angle 

IPAHTl FILTER 

|Vt3)S 

1-1B0 < xldeg 

125 

1 

I 

1 

1 estlaate 

1 _ 

1 

1 

1. 

i<= 180 1 

1 

_L 

1 

-I 

lEITBAP SATE EST2 

1 Extrapolated filter 2 body 

(PARTI FILTER 

|V(3)S 

ITBD Ideg/s 

125 

1 

i 

f 

(angular rate estinate 

1 . 

1 

1 

1 1 

1 

1 

t 

I 

JBIHBAL_AKG1ES OLD 

1 xau giabal angles 

(PAHT1 FILTEH 

|A{3)S 

|-180 < E|deg 

|25 

1 

1 

1 

1 

j 

1 

1 <= 1 80 t 

1 

1 

1 


TABLE <*.2.2.3 

,2-2 PABT2_FILTEE 

CO K ST A RTS 





) I ) I I I 

I waar t DEscEitiioa I type i vattiE t usit i 


1 

1 

I 

1 

1 

1 

1 

1 j 
1 

li 

* 1 
1 1 

I 

1 1 

i 

1 

I 

1 

! 

i 

1 

1 

i 

(TDAP 

J 

(Period of PC cycle 

t . ... .._ 

(S 

__ -i 

]0.C<* IS 1 



4 . 2 . 2 . 4 TVC DAP 


I 


I 


4. 2. 2, 4.1 DELTA OMEGA OMS ENGINE 


A. Function : This module computes the modelled body angular 

rate increment due to torque from the OMS engines during 
a TVC burn. 

B. Block Diagram : Figure 4. 2. 2. 4. 1-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements : Table 4. 2. 2. 4. 1-1 

E. Constants ; Table 4.2. 2. 4. 1-2 

F. Initial -a tion Requirements : none 


I 
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Figure 4. 2. 2, 4. 1-1. DELTA OMEGA OMS ENGINE. 
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TIBLE 4-2.2. U. 1-1 DELTA OHEGA OHS EHGIME INTEFFACE rEOTIIEEMI iltS 


1 

1 

1 

1 



I 

I 

1 

SOUaCE OL 1 

1 

1 

1 

1 

1 

1 

1 hahe 

J_ 

1 

1 

DESCaiEllOH 

I 

i 

DESTIHATIOH | TYPE 

1 EflUGE 

1 UNIT 

1 FAT? OlYl 
i 


IlDpats 

! 

1 



1 

1 . 

1 

1 

1 

1 

1 

1 

1 

1 . 

joHSl CG 

j vector froB 

OHS1 hinge point to 

(OHS 

EEETHSnST HANEOV- ( V (3) S 

ITBD 

If 

1?5 

1 

» 

ivehicle eg. 

in body ares 

(Efi 

1 

1 

J 

1 

1 - 

1 

{OHS2 CG 

(Vector froB 

0KS2 binge point to 

(OHS 

PEETHEOST HAEEOV- 1 V (3) 5 

(TEE 

If 

I2f 

1 

1 _ _ . 

1 vehicle eg, 

1 

in' body axes 

lER 

1 

1 

i_ 

1 

1 

_i . _ 

J011S1_EITCH_IA« 

1 

IOHS1 

1 

engine 

pitch and yav 

(SOP 

1 

1A{2)S 

ITBE 

i- 

1 deg 

J _ _ 

|25 

i_ 

|0BS2_PITCH_VA(f 

iattS2 
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pitch and yaw 

(SOP 

1 A(2)S 

1TBB 

|deq 
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1 

l_ 




] 

1 

1 

1 

|OMS1_OH_CBD 

1 

(OHS1 
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1 o«s_ 

.EEG_CHD 1 B 

I0,1 
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i 

125 

|0MS2_0H_CBD 

1 

IOHS2 

1 

on coBRand 

(CHS 
„JI 

.E1IG_CHD 1 P 

I"),! 

i .. . 
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. 1 . 

125 

L_„ 

IVEHICLE.IHVEESE 

IHE-| Inverse of vehicle inertia 

(SF 

S 

ITBD 

iVtlslug) (f 

1 -125 

(ETIA 

1 

1 

1 



1 

1 

1 

1 

t {fM 

J 

1 

i 










1 Outputs 
1 

1 



1 

j 

1 

1 

i .. .. _ _ . 

1 

_ 1 _ 

IDEITA OHEGA OHS 

(Hodelled body angular rate 

|EART2_F1LXEB |V(3)S 

ITPD 

1 deg/s 

126 


increaeat dae to CHS TVC 
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lABlE 4,2.2. 4*1-2 DBLTA„QHEGA_OHS_EHGIHE CONSTANTS 


1 

1 HA HE 


1 

) DESCRIPTION 

I 

1 TYPE 

1 

1 VALUE 

1 

1 UNIT 

1 

1 

1 


.. 1 ..... _ .... .... 

1 

1 

-| 

i 








IACX1 TO yEH 


ioHsi actuator axes to vehicle axes 

|H(3,3}S 

1 See Note 1 

inone 

1 

1 


itransfcEuation natrix 

1 

1 

) 

1 

1 


1 

... _ r 

1 

_l _ 

i 

JACT2 TO VEH 


iOttS2 actuator axes to vehicle axes 

|M(3,3)S 

|See Note 2 

tnone 

1 

1 


ItransfornatioD natrix 

1 

t 

1 

I 

t 


1 

\ 

1 

1 

i 

|TBB 

1 


IHcminal thrust of a single OHS engine 

IS 
1 _ 

|600C 

|lLf 

1 

1 

ITDiP 


1 Autopilot ninor cycle tine 

IS 

O 

* 

is 

1 

1 


1 __ __ 

, . 1 .--- 

1 

t 

I 

JDEG TO HAD 


t Degrees to radians conversion factor 

IS 

1 pi/1 80 

1 rad/deg 

1 

I 

* 

1 ' 

1 

1 

u 

i 

IB&D TO DEG 

i 


IBadians to degrees conversion factor 

js 

1 180/pi 

{ deg/rad 
l_ 

1 

_i 


note 1: 

ACTl TO VEH 


-COS (x) COB {y) 

-sin(y) 
-sin (x) cos (y) 


-cos (x) sin (y) 
cos{y) 

-sin (x) sin (y) 


sin(x) 

0 

-cos (x) 


where x = 15.8167 deg 
y - 6.5 deg 


Note 2: 

ACT2 TO VEH = 


-cos (x)eos(y> cos (x) sin (y) sin(x) 

sinCy) cos{y) 0 

-sin (x) cos (y) sin(x)sin {y) ' -cosCx) 


where x = 15.8167 deg 
y = 6.5 deg 


4. 2. 2. 4. 2 ENGINE CG CMD 


A. Function: This module computes the OMSi and 0MS2 engine 

pitch and yaw servo trim commands necessary to point both 
engines through the vehicle center of gravity. 

B. Block Diagram : Figure 4. 2.2.4. 2-1 

C. Processing Rate : 1/maneuver 

D. Interface Requirements : Table 4. 2. 2. 4. 2-1 

E. Constants : Table 4. 2. 2. 4. 2-2 

F . Initialization Requirements : none 


154 












156 


TABLE «.2.2.4,2-l EHGIHE_CG„CMD INTERFACE REOUJarHEHTE 
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■ SOOBCE OR 

1 

1 

I 

1 

1 

1 

1 

1 35 ''FIE 
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1 DESCEIETIOK 
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5 

t 
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i 
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1 

1 

1 

1 

1 

1 

I 

_i 

1 

_1 
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-1 Vp)S 
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If 
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i 

1 
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I 

1 EH 

■ 
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1 

1 

i 

1 
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-|V (3) S 

|TBD 

1 : 

1 l/iranj-uver 

1 

(vehicle eg. In body axes 

■ ER 

■ 

1 

1 

1 

1 

1 

. 1 

1 

i 

I - 

1 - - 


■Outputs 

■ 

1 

1 

i 

1 

1 

1 

1 

1 

1 

_J 

a 

i ___ . „ 

I08S1 TBIH 

tOHSI engine pitch and yau tcin 

(T7C LAN PITCH- Si AW 

IM2}5 

ITFC 

1 deg 

1 l/mati cuvet 

1 

1 

(values 

1 

t 

1 

f .. . 

i 

1 

i _ 

I 

10BS2 TBIH 

I0H52 engine pitch and yau trie 

■TVC_LAH„PITCH_YAH 

|A(2)S 

|TFD 

I deg 

1 1 /man&uver 

■ 

(values 

1 

1 

1 

1 

I 


L_ 

„JL_ _ _ 

,i 

J - 

-1 

_1 
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TABLE 4.2.2. «. 2-2 EHGI«E_CG_CMD COKSTANTS 


1 

J HAKE 

1 

1 

j DESCHIPTIOH 

1 



! 

1 TYPE 

1 

1 VALUE 

! 

1 U HIT 

1 

1 









IVER TO ACTl 

1 

1 

1 Vehicle axes to CKS1 actuator 
1 transfer nation matrix 

axes 


|K(3,3JS 

1 

L . .. 

|See note 1 
1 

■ none 

1 

.( 

1 

f 

i 

IVEH TO ACT2 

1 

1 

(Vehicle axes to btSS2 actuator 
1 transfornation natrix 

i - 

axes 


IH(3,3 ) S 
1 

|See HotP 2 

1 

C none 
1 

1 

1 

i 

(EAB TO BEG 
J 

{ Badians tc degrees conversion 
J „ 

factor 


jS 

1 180/pi 

[ deq/rad 

! 


Note 1 ; 


VEH TO ACTl 


-cos(x)cosCy) 
-cos(k) sin (y) 
sin (x) 


Note 2: 


VEH TO ACT2 = 


-cos (x)cos (y) 
cos (x) sin(yl 
sin(x) 


-sin Cy) 
cos (y) 
0 


sin{y) 
cos (y) 
0 


-sin {x) cos (y) 
-sin(x) sin (y) 
-cos (x) 


-sin (x) cos {y) 
sin Cx) sin Cy) 
-cos (x) 


Inhere x = 15.8167 deg 
y = 6.5 deg 


where x = 15.8167 deg 
y = 6.5 deg 






4. 2. 2. 4. 3 ENGINE PRETHRUST TRIM 


A. Function : This module computes the OMSL and 0MS2 engine 

yaw and pitch servo trim commands such that the engine 
thrust vectors are parallel and there is no net torque on 
the vehicle. 

B. Block Diagram : Figure 4. 2. 2. 4. 3-1 

C. Processing Rate : 1 /maneuver 

D. Interface Requirements : Table 4. 2. 2. 4. 3-1 

E. Constants : Table 4. 2. 2. 4. 3-2 

F. Initialization Requirements: none 
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Figure 4. 2. 2. 4. 3-1. ENGINE_PEETHRUST_TRIM 
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TABLE 4. 2.2.4. 3-1 EHGIHE_PEETHBUST_TRlil IBTERPACE REOtTIPEBEHTS 


1 

1 

1 HA HE 

1 

1 

1 DESCRIETIOH 

I 

1 SOUHCE OB 

1 DESTINATIOH 

1 . 

1 

1 TTEF 

1 

1 
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1 

i 

1 

i 

1 

1 SSaPLE 
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1 

1 

1 
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1 

1 
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1 

I 
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1 

I 

1 

i 

1 

1 
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IVectot frca 

OMSl hinge point to 

|OHS PHETHflOST HAHEUV 

-|V(3)S 

ITBD 

If 


1 

1 

1 ... 

1 vehicle cq , 

1 

in body axes 

1 EB 

1 

_J 

1 

l._ 

1 

1 

i 

I 

^ 1 

(0H52 CG 

1 Vector fron 

0HS2 hinge point to 

1 OHS_PaSTHEUST_HAHEtJV- 

-|V (3)S 

|TBD 

If 


1 

! 

i vehicle eg. 

in body axes 

1 ER 

1 

1 

1 

1 

1 

f 



i 

1 
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1 

^ 1 


(Outputs 

1 


1 

1 

i 

1 

1 

1 

f 

J 


I 

1 

1 

_i 
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_i 

IOBS1 TRia 

|OHS1 engine 

pitch and yaw trim 

ITVC_LAH PITCH_YAfl 

IM2)S 

ITDt 

|deq 

1 1/naneuver 

1 

1 

1, .. . _ 

1 values 


1 

1 

1 

1 

„J 

1 

i __ 

1 

J. 

1 

IOHS2 TEia 

j OHS2 engine 

•pitch and yaw triii 

1TVC_LAW_PITCH_YAW 

|A(2)S 

ITBD 

1 deg 

1 1 /maneuver 

! 


1 jvalUEs ! 111!! 






TABLE 4. 2, 2, 4. 3-2 EKGIHB_PEETHP.UST_TfiIM COHSTAHTS 


^ Q 

s| 

4 

ata 


t UAHS 

1 

* DESCEIETIOH 

1 _ 


1 

1 TYPE 

i 

1 

VALUE 

T" 

1 oniT 

1 

1 

i 










17Ea_T0_ACT1 

1 

1 Vehicle axes to Ohsl actaatoc 
i transfaraatioa natrix 

axes 

|5(3, 3)S 
1 

1 see 
1 

Kote 

1 

(none 

1 

1 

1 

1 

1 - - 


1 




\ 

1 

iVEH T0_ACT2 

1 

1 

(Vehicle axes to cas2 actuator 
(traDsforsatioa aatriz 

. _ __ . 

axes 

|H(3,3)S 

\ 

1 

(See 

1 

Note 

3 

Inone 

1 

1 

1 

i 

|BADjrO_DEG 
J 

(Eadians to degrees convetsi 

factor 

IS 

1 

1 100/pi 


(deg/rad 

1 

L 


note 1 : 


VEH TO ACTl = 


-COB (X) cos (y) 
“COS (x) Bin {y) 
sin (x) 


-sin (y) 
cos (y) 
0 


-sin (x) cos (y) 
-sin(x) sin{y) 
-cos [x) 


where x = 15.8167 deg 
y = 6.5 deg 


Note 2; 


VEH TO ACT2 = 


sin(y) -sin (x) cos (y) 
cos (y) sin (x) sin {y) 
-cos (x) 


where x 

y 


= 15.B167 deg 
= 6.5 deg 


L 


-cos(x) CDS Cy) 
cos (x) sin (y) 
sin(x) 


0 


4. 2. 2. 4. 4 GUIDANCE COMPENSATION 


A. Function ; This module provides gain and compensation filter- 
ing for the guidance loop in pitch and yaw during normal 
burns in the auto TVC submode. 

B. Block Diagram : Figure 4. 2. 2. 4. 4-1 

C. Processing Rate ; 25 Hz 

D. Interface Reguirements ; Table 4. 2, 2. 4. 4-1 

E . Constants ; none 

F. Initialization Requirements ; Table 4. 2. 2. 4. 4-2 
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Figure 4. 2. 2. 4. 4-1. GUIE:AWCE_C0MJPENSATI0N 
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TABLE 4.2.2.li.«-l GUIDAMCE COHPEHS AT IO!l IHTEBFACE FEOUIEEHE N T5 


1 

1 

■ 

1 


1 

1 SOUPC’=' OH 

1 

1 

1 

1 

1 

1 

1 1 
1 S.SHELF 1 

t SA6£ 

) DESCEIPTIOK 


I D3STIHAT10N 

1 TYPF 

1 .AVC-I 
1 

1 4MIT 

I 

1 

(HZ) 1 

i 


Jlnpttts 

1 


1 

1 

1 

1 

1 

1 

1 

1 


J 

1 

1 

1 .. _ _. 

.L 

) 

|OHEGA_C_AnTO 
1 . 

ICoBEianded body angular 

-1 - 

rate 

1 ADTD_TVC 

1 V{3)5 

■ TBD 

1 deq/s 
i _ 

|25 

___1 

1 

i 

JGBID COBP GAIK 

1 TVC coapeusation gains 


iCFC HECOH 

IA(3)S 

1 2-engine 1 none 

(26 

1 

1 
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IAB12 4.2. 2.i|.4-2 GaiDAHCE_COHPEfiSiTIOM IHITIiMZaTXOK aSQUIEESENTS 
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4. 2. 2. 4. 5 GUIDANCE GAIN RCS ASSIST 


A. Function : This module provides gain reduction for the 

guidance loop in pitch and yaw when the RCS DAP is helping 
to control the vehicle attitude in the auto TVC submode. 

B. Block Diagram i Figure 4. 2. 2. 4. 5-1 

C. Processing Rate : 25 Hz 

D. Interface Requ-^ rements : Table 4. 2. 2. 4. 5-1 

E. Constants : Table 4. 2. 2. 4. 5-2 

F. Initialization Requirements ; none 
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TiBiS 2. 2.4. 5-1 GniDAHCE„GAIK_BCS_ ASSIST IBTEe.FACE Er ODIPEMiNTS 
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TABLE 4. 2, 2. 4, 5-2 GUIDAHCE_GA1B BCS ASSIST COHSTABTS 


I " ■ I " _ — ^ ^ ^ - 

I HAKE ( DE3CBIPTI0M | TYPE I VALUE | UNIT I 


7p_y_GAIB - J Pitch and yaw cowBand gain |S [0.16 I none I 






4. 2. 2. 4. 6 OMS ENG CMD 


A. Function ! This module computes the OMSl and 0MS2 engine 
on commands. 

B. Block Diagram ; Figure 4.2. 2. 4. 6-1 

C. Processing Rate : 25 Hz 

D. Interface Recfuirements ; Table 4. 2. 2. 4. 6-1 

E. Constants ; none 

F. Initialization Requirements; Table 4. 2. 2, 4. 6-2 
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INiT_OMS_ENG_CMD 

[0MS_A^_RE01 

[0MS^0N_REQ] 

omsiIfail 

0MS2‘ FAIL 


0Msi_0N_CNiD = oms_arwi_,req,«owis_6n_REQi*omsi_fail 


iOMS2_ON_CW)D =0MS_AR’M_REQ2e 0MS_0N_REQ2» OMS2_FAIL 


ENG CMD 



Figure 4. 2. 2. 4. 6-1. OMS_ENG_CMD. j 

\ 


i 

i 
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TABLE 4. 2. 2. 4. 6-2 OHS_EHG_CHD IHITIALIZATIOH EEQOIBEMEHrS 
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1 INITIALIZE ON TEANSITION 
1 FEOH 
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1 laiTIALIZB ON TBANSITION 
1 TO 
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_J 
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4 . 2 , 2 . 4 . 7 PITCH_YAW_ASS IST_C0MPUTAT10N 

A. Function ; This module determines whether the TVC DAP 
requires assistance from the RCS DAP for yaw and pitch 
control, on the basis 3f the body rate estimate from the 
State Estimator. Hysteresis is incorporated to prevent 
noise from causing unnecessary cycling. 


B. Block Diagram ; Figure 4. 2. 2. 4. 7-1 

C. Processing Rate : 25 Hz 

D. Interface Requirements ; Table 4. 2. 2. 4. 7-1 

E. Constants ; Table 4. 2, 2. 4. 7-2 

F. Initialization Requirements: Table 4. 2. 2. 4. 7-3 
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NOTE; LOGICAL OPERATION. 


Figure 4. 2. 2. 4. 7-1. PITCH_YAW_ASSIST_COMPUTATION. 
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TABLE 4.2.2, 4.7-2 PITCH TAB ASSIST COHPUTATIDS CONSTANTS 
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TAELB 4. 2. 2. 4. 7-3 PITCH_7 AW„ASSIST_COttPUTATION IBITIALIT.ATION SEQUIPEHENT5 
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TO 
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4. 2. 2. 4. 8 RCS_ASSIST_PlTCH_yAW 

A. Function ; During the RCS assist mode of TVC operation, this 
module forms the pitch ar.d yaw components of vehicle atti- 
tude and angular rate errors. Desired attitude is the 
integral of the commanded body rates; measured attitude 
is the integral of the body attitude increments derived 
from gimbal angle increments. Both Integrals are zeroed at 
initialization. Attitude error is the difference between 
the desired and measured quantities. Rate error is the 
difference between the commanded and estimated body rates. 


B. Block Diagram ; Figure 4. 2. 2. 4. 8-1 

C. Processing Rate ; 25 Hz 

D. Interface Requirements ; Table 4. 2. 2. 4. 8-1 

E. Constants : Table 4. 2. 2. 4. 8-2 

F. Initialization Requirements ; Table 4. 2. 2. 4. 8- 3 
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laSLE 4.2.2. 4, 6-2 ECS_&SS Isr_PITCB YAB CQWST&HTS 
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TABLE 4.2. 2.4. 8-3 HCS_asSIST_PITCH_yAH IHITIALIZATIOS BEQUIHEMEHTS 


ihiiialize oa TE^asriios 
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iiaiT ECS ASSIST PITCH TAB = 
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I 
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1 
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4. 2. 2. 4. 9 


RCS_ASSI ST_ROLL 

A. Function ; During the RCS assist mode of TVC operation, 
this module forms the roll component of vehicle attitude 
and angular rate errors. Desired attitude is the integral 
of the commanded body rates; measured attitude is the 
integral of the attitude increments derived from gimbal 
angle increments; both integrations are zeroed at initiali- 
zation. Attitude error is the difference between the 
desired and measured quantities. Rate error is the differ- 
ence between the commanded and estimated body rates . 

B. Block Diagram ; Figure 4. 2. 2. 4. 9-1 

C. Processing Rate ; 25 Hz 

D. Interface Requirements : Table 4. 2. 2. 4. 9-1 

E. Constants : Table 4. 2. 2. 4. 9-2 

F. Initialization Requirements : Table 4. 2 -2. 4. 9-3 
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'ABLE 0.2. 2. U, 9-1 
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TABLE fl,2,2.4.9-2 OCS_iSSIST SOLE COHSTAHTS 
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TABLE 4.2.2, 4,9-3 ECS_ASSIST BOLL IHITlALIEATIOK EEQUIREBEHTS 
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IDES I BED ATTITUDE 

( 

1 ATTITUDE fl 
1 

IGA OLD 

_J 


10 1 

I j 
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4.2.2.4.10 TVC_LAW_P ITCH_YAW 

A. Function t This module closes the inner loop of the TVC DAP 
when RCS DAP assistance in pitch and yaw is not required. 
Vehicle pitch and yaw ratec are derived by back-differencing 
the IMU angles, dividing by the time step and transforming 
from IMU rates to body rates. The body rates are subtracted 
from the commanded rates to form rate errors, which are proc 
essed by compensation filters and passed through 
proportional -plus-integral paths. The outputs are limited 
and passed on as position commands to the QMS engine actua- 
tor servos. The pitch channel compensation filter contains 
a sign reversal to account for a second reversal that takes 
place in the engine-vehicle relationship (in which positive 
engine pitch induces negative vehicle pitch) . The yaw 
channel does not require such a reversal because the vehicle 
and actuator coordinate frames have approximately opposed 

Z axes, and thus positive engine yaw about the actuator 
Z axis induces positive vehicle yaw about the vehicle Z axis 

The initialization of this module includes two significant 
actions. The TVC DAP gains are set as an inverse function 
of the number of QMS engines operating; re-initialization 
is th”s required if this number changes. Secondly, depend- 
ing on the value of the initialization flag (which for this 
module is an integer) , the integrators in the proportional - 
plus-integral processing may either be allowed to remain 
containing the final values from the previous TVC burn, or 
initialized to a value computed outside the module. In 
either case the integrator contents are immediately passed 
on as initial engine trim commands. 

B. Block Diagram : Figure 4.2.2.4.10-1 

C. Processing Rate ; 25 Hz 

D. Interface Requirements : Table 4.2.2.4,10-1 

E. Constants ; Table 4.2.2.4.10-2 

F. Initialization Requirements ; Table 4.2.2.4.10-3 
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TABLE 4.2,2.4.10-1 TVC_LAH_PITCH_YAH INTERFACE REQBlREHEHTS 
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1 CoBBanded body angular rate 

jGDIDAHCE COHPEIISAXIOH( V(3)S 

lTHr 

1 deq/s 

125 

! 

1 (pitch and yaw 

J 

lor KAHUAL TVC 

! 

1 

1 

1 

1 

Iconponents) 

1 

1 



1 

1 . 

1 

1 

{ 

■J- _ 

1 

1 

1 

1 

1 

1 

{GIBBAt ARBLF.S 

]IH0 ginhal angles 

1 SOP 

1 A(3)S 

{-180 < 

X { deg 

1 25 

t 

1 

1 

I 

i 

1 

1 

1 

{<= 18C 

{ 

i 

1 

( 

1 

{OHS1 C(i 

{Vector froB OilSI hinge point to 

|0H3 PEETHHDST_HAHEUV-|V (3)S 

|TBD 

{ f 

{ 1 /maneuver 

I 

1 

{vehicle eg, in body axes 

isa 

1 

1 

1 

1 

1 

1 

i - . .. 


( 

1 

1, .. 


I 

{VEHICLE IHVEESE IKE- 

{Inverse of vehicle inertia 

I SF 

IH (3,3) 5 

{TBD 

i 1/((slug) (f 

) -1 l/uaneuver 

1 

lETIA 

1 (pitch and yaw 

1 

i 

1 

1 

! 

t 

t 

1 (f) ) 

1 

1 

1 

1 

1 

jKoaentsI 

1 

1 

J 

1 

{ .. . 

1 

1 

1 

_J 

i 

1 

_i 

|TVC LAW P_I GAIH EX- 

‘(Flag indicating nunher of OHS 

|OFc ascoH 

{I 

ii»2 

1 n^ne 

1 1/maneuver 

1 

lAG 

1 

( 

1 

{engines to burn 

1 

1 

1 

1 

{ 

1 

1 

{1=1 engine 
1 

i 

! 

1 

1 

! 

1 

1 

1 

1 

1 

1 

1 

1 

1 

{2=2 engines 

1 . 

{ 

{ 

t 

t 

1 

! 

1 

1 

i 

|IN1T_TVC_LAH_PITCH_- 

i;ah 

( nodule initialization flag 

ICFC EECDH 
1 

1 X 
1 
1 

{0,1,2 

1 

1 non^ 
1 

|25 

1 

1 

1 

1 

1 

i 

1 

{Cl = no init 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

\ 

1 

1 

f 1 

|1 - init; using trim value derived! 

1 

1 

\ 

\ 

1 

\ 

1 

1 

1 

1 

1 

{frou previous OHS turn 

1 

1 

1 

{ 

1 

( 

1 

1 

I 

1 

{2 = init using OHS1 TBIH and 

(0HS2_ThIH 

I 

1 

1 

1 

1 

i 

1 

1 

1 

1 

( . 

1 

1 

r 

_i _ 

1 

1 

1 

1 

_I 

|OKS1_THIH 

{OHS1 engine pitch and yaw triv 

{ EHGIHE_CG_CHD or 

1 A (2)5 

jTBD 

{ dea 

1 1/maiieuvet 

1 

1 

1 

{values 

1 

1 EHGmE_PHETIIFOST_ 

TRIH 1 

1 

1 

i 

1 

1 , .. 

1 

_J 

IOHS2 TfiXH 

{0HS2 engine pitch and yaw trxQ 

[EMGlHr CG„CHD or 

1 A(2)S 

ITPF 

1 deq 

1 1 /maneuver 

1 

1 

J 

i values 

I . . 

lEHGIHE PBETHHUSX. 
._j 

TXIHt 

1 

J 

1 

1 

1 

i 
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TABLE 4.2.2. JJ. 10-1 


TVC_LAH_PITCH_YAH INTEHFACE 5EQ BiaEHEIlTS 


1 

! 

i 

1 

1 

1 

SOURCE OR 


mRH 



1 

1 

1 HADE 

1 DESCEIPIIOH 

I 

DESTIHATION 

1 TYPE 




1 

J 

1 

J 




HWi 


i 







mm 


m 

lOutputs 

1 

1 

1 


1 

1 

1 

.1 „ 

i 

1 

i 

1 BITCH TVC CHD 

1 Pitch ocnpaiient cf pitch servo 

]TVC 

aiXER 

1M2)S 

(pitch: 

(deq 

1 25 

1 

1 

(coBiand, for OHS1 and OH52 

» 


t 

(-6 <= X 

1 

[ 

! 

« 

1 

(engines 

I 

1 

1 


1 

1 

|<= 6 
( yaw : -7 

1 

1 

1 

1 

1 

1 

1 

i 

1. 

I 

I 

I 

1 

1 

1 


1 

1 

i<= X <= 

|7 

1 

1 

.1 

1 

1 

1 

1 

1 

_1 

I0BS1 PITCH TAB CHD 

(OHSl engine pitch and yatt servo 

(SOB 

‘ 

|ft (2)S 

( pitch ; 

[deg 

|25 

I 

i 

1 

1 

1 

1 conaands 
1 
1 
I 

1 

1 

1 

1 


i 

i 

1 

1 

i-6 <= X 
(<- 6 
jvaw: -7 

I<= X <= 
t *7 

1 

! 

1 

( 

1 

1 

1 

1 

1 

1 

1 

1 

i 

i 

1 

1 

1 

1 


1 


1 

1 

\ 

I0HS2 PITCH lAH CHD 

iOHS2 engine pitch and yav servo 

(SOP 


|A(2)S 

1 pitch: 

1 deq 

125 

1 

; 

1 

1 

1 

i 

j 

jccmnands 

1 

1 

1 

i 

1 

1 

1 

1 

i 


I 

1 

t 

1 

1 

J 

1-6 <= X 
|<= 6 
lyau; -7 

t<= X <= 
(■? 

i 

1 

1 

i 

-i 

1 

t 

1 

i 

1 

1 

1 

t 

1 

1 

-I 
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TABLE 4.2.2.4.10-2 T¥C_LAH_PITCH YAH CONSTANTS 









H' 

03 

CO 


XiBLE «, 2,2. il. 10-3 TVC_LMf„EITCn_ YA9 XNITI&tlZATIOK FEQDIEEHEKT5 


1 

1 IHITIAIIZE OB TBXHSITIOM 
1 FROM 

1 

1 ISITIALIZB OS TRASS ITIOH 
t TO 



1 

1 

1 

1 

VARIABLE 1 ISITIAL VALOF 

1 

f 

1 

1 

1 


(IHIT TVC LAH PITCH YAH = 0 
1 

1I8II_TVC_1AH_PITCH„IAH = 1 

} DC 2 

IKY 

i 

1 Note 1 
1 

1 

1 

1 

1 

[ 

IKE 

1 

(Note 2 

1 

1 

1 

1 

1 

1 

1 

1 Hades (3 each) 

1 

1C 

1 

1 

1 

1 

1 ... . . _ 

1 

[ 

. 1 

|GA_OLD 

1 

1 GTMBA t_AHGLES 

i 

JIHIT TVC LAH PITCH YAH ~ 0 

1 IHIl_TTC_tAH_PITCH_YAH = 2 

|IST1_PITCH 

1 bHS1_TM.1$ (1) 

1 

1 

1 

1 

1 

1 

|IHT1_YAH 

1 

1 0H5l_Ti IMS {2) 

1 

I 

1 

1 

1 

1IHT2jPITCU 

1 

1 0HS2_ TRIMS {1 ) 

1 

1 

1 

J 

1 

j 

1 

11HX2_YAH 

1 

1 0HS2_TBI1S (2) 

1 

— 1 


Note 1: 

2K 

■P VEHlCLE^INVEKSE^INERTIAj ^ OMSl_CGj^ TVC_LAW_P_YJ3AIN_Fi:,aG 
Note 2: 

2K 

T VBHICLE^INVERSE^INERTIA^ ^ 0HSl_CGj^ TVC_LAH_P_Y_GAIN_FLAG 


4.2.2.4.11 OTC Law ROLL 


a. Funet-ion ; Tills module provides control of the vehicle in 
roll during two- engine TVC turns - 

B. Bloch Diagram s Figure 4.2.2.4.11-1 

C- Processing Eatea 25 Hz 

D. Interface Beguirements s Table 4-2.2-4.11-1 

E. Constants ; Table 4.2.2.4.11-2 

F. Initialization Requirements s Table 4.2.2,4.11-3 


c ■ > 
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OBlGINMi BA.GE IS 
OF POOE QUALOT 


i-j 

O 



. TVC LAW ROLL 


Figure 4.2.2^4.11-1 




TABLE J|. 2.2. 4.11-1 TVC_LA« ROLL IHTEaPACS EEQHIPEKeKTS 


1 

1 

I HAHE 

J 

1 

1 

1 DESCBXmOH 

1 

1 BOOBCE oil 

1 DSSTIHATIOH 

1 

1 

! TYPE 

i 

1 

1 

1 BAM BE 

! __ 

I 

I 

I UNIT 

I 

I 

I SAMPLE 

I PATE (HZ) 
1 ^ 

1 

1 

1 

1 

■ 

1 Inputs 

1 

.1 - 

t 

1 __ 

1 

.1 

1 

.J 

I 

1 

1 

jOKEGA_C_BODr 
1 {coll coKponent) 

±.-. - 

ICdMHanded body. angular race 

1 

IGDIDAHCE C0HPEHSATI0H|V(3)S 
lor aAKUAl_TVC 1 

|TBD 

! 

1 

! deg/s 
I 

,_i 

!25 

1 

-_i_ 

1 

t 

_i 

1 1 HIT_TVC_LATI„fiDLl 

-1. , ■ 

IHodule Initiailtation £lag 

- 

|OFC„RECOH 

IB 

1. . 

10,1 
-i »_ 

I none 

|25 

1 

_i 

I6IHQAL XHGLES 

1 

1/ 

HEO ginbal angles 
1 

I- . . 

(SOP 

1 

1 A t3) S 
1 

J_ 

1-180 < 
|<= 18C 
-1_ - 

x|deg 

I 

I 

[25 

1 

1 

I 

1 

1 

|VEB1CLE_IHVBBSE_IKE- 

IBTIA 

1 (coll KOMen-t) 

1 . . 

•JlnvecEB of vehicle inertia 

1 

1 

1 

ISP 

1 

1 

l«(3,3)S 

t 

1 

ITBD 

I 

I 

IV ((slug) {f) 
I {£)) 

I 

I 

-125 

1 

! 

( 

1 

) 

1 

1 









t Outputs 

1 - - 

! 

-J - ... . 

1 

1 

1 ... 

I 

I 

1 

1 

IBOLli TVC CEO 

1 

J 

ISoll coHponent of pitch servo 
jconnaod for OMS engines 
_ 

ITVC MIXER 
1 

|3 

t 

ITBP 

I 

-Jl — 

(deg 

I 

125 

1 

1 

1 
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TiBLE 4.2.2.4,11-2 TVC_I.AH_K0L1 COHSTASTS 




1 

1 

1 

1 

1 

i 

HAHB 

1 DESCEIPTIOH 

1 TYPE 

1 VALBS 

1 nsiT 

1 



\ - - - .. 

1 

1 

i 

i 








|K 

t 


IBall autopilot- vehicle gain product 
I 

IS 

l._ 

|TBD 

1 

Inone 

1 

i 

IHLIH 


{Liiiiting value for roll couponent of 

pitch servo! s 

ITBD 

I deg 

1 

1 

1 


icoxsiaod for OHS engines 

.. I_ ... _ . 

1 

1 

1 

1 

1 

i 

IKZEI 


1 Integrator gain 

IS 

ITBD 

inane 

1 

1 


1 

J 

1 

1 

L 

|S5 


1 Elites coefficient 

t - 

1? 

ITBD 

inone 

1 

IT 


lluo-engine thrust value 

IS 

1 12CC0 

Ilbf 

1 

1 


1 



1 

- i 

ILY 

I . _ 


{OHS engines Y-axis separation 

1 

IS 

! 

114.7 

If 

1 

i 

{imp 


{Period ot lYC DAE cycle 

IS 

10.04 

|s 

1 

J- _ 


1 

1 

-i _ _ 

L_ 

i 


TABIB 4.2.2.4.11-3 TVC_I,AB_ROBL IHlTIAimTIOM BEQOISEHEHTS 


1 

1 DtlllALIZB DM THABSIIIOH 
1 EBoa 

I 

1 

1 IMIIIALIZE OB 
1 . TO 

i 

IBABSIIIOK 

1 

1 

VARIABLE 


1 

t INITIAL VALUE 

1 

1 

1 

I 


IIKIT„T7C_R0LL = OFF 

|1HIT_TVC_B0LL = 

OH 

|KR 



IHote 1 

1 

1 

i 

1 


|EI1TEB„0UT 



I 

|0 

{ 

1 

1 

I 

i 

1 


1 

|GA_OLD 



1 

|GIhDAL_AMGLES 

1 

1 

I 

1 

J — 

1 

J 


II m_ BOLL 



1 

10 

1 

1 

-- JL 


Hate It 

_K 

® LY VEHICLE INVERSE INERTIA^ , 

"" XfX 




-4-12 TVC MIXER 


A. Function ; This module derives the OMSl and OMS2 pitch 
actuator servo commands as the difference and sum respec- 
tively of the pitch and roll TVC commands - 

B. Block Diagram ; Figure 4.2.2.4.12-1 

C- Processing Rate ; 25 Hz 

D. Interface Requirements ; Table 4.2.2.4.12-1 

E . Constants ; none 

F. Initialization Requirements ; none 
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SIBLE H-. 2. 2. 4, 12-1 TVC„H1XES ISTEBPACS fiEgUIEBHEMTS 


I 

1 

t XAHE 

J 

1 

1 

I DBSCEIETIOH 

1 

1 SOUECE OB 

1 DESTINATIOH 

1 

1 

1 TYPE 

1 . .. 

1 

i 

I PAHGE 

1 

\ 

1 

1 UHIT 

! _ 

1 

1 SA »P1E 

1 PATE (HZ) 

1 . . . . . 

1 

1 

1 

1 

* 

{Inputs 

.1 

1 

1 

1 

1 

1 

1 . .. 

1 

1 

1 

1 

L _ _ 

! 

. 1 

IHOiL TTC CHD 

i 

1 

IBoll cosponeataf pitch servo 
jcoiiand for OHS engines 
f . 

|IYC_LMf„H01L 

1 - 

IS 

1 

ITBD 

1 

Idaq 

1 

_ 1, .. 

125 

1 

1 

1 

1 

*_1 

1£IICU_'CTC_CKD 

\ 



I Ditch coaponent of pitch servo 
icQiKund, for aM51 and 0HS2 
(engines 

(IVC^LAH PITCH 1AH 

1 

1 A (2) S 
1 
1 

i 

ITBD 

1 

1 

|deg 

1 

1 

t 

125 

t 

1 

1 

1 

1 

1 

1 


lOuputs 

« - 

1 

t 

.1 

t 

1 _ 

1 

! 

1 

1 

1 

1 

1 0M51_5ITCH_r AH_C HD 
1 (pltcU eleiienty 
1 

(OHSI engiine pitch and yaw servo 
jcoKiaiids 
1- 

(SOP, BH 
1 

1A(2)S 

i 

(TBD 

i 

1 _ 

|deq 

1 

125 

1 

1 

1 

—i 

|0«S2_?ITCH_IAV„CHD 
{ (pitch eleaent) 

J 

1 0HS2 engine pitch and yav servo 
(coBiands 
-L. __ 

(SOP, EH 
1 

^1 

1 A 12) S 
! 

ITBD 

1 

ideq 

1 

-1 

|25 

1 

1 

1 

„i 





4. 2. 2. 5 Service 
4 . 2 . 2 . 5 . 1 AHGLESJPOJDCM 

A. Function. : This module generates a direction cosine matrix 

that transforms a vector in body coordinates to one in IMU 
stable member coordinates. The matrix is rectangular and 
thus its transpose may be used for the inverse transforma- 
tion. 

B. Block Diagram : Figure 4. 2. 2, 5, 1-1 

C. Processing Rate : As called 

D. Interface Requirements : Table 4. 2. 2. 5. 1-1 

B. Constants: Table 4. 2. 2. 5. 1-2 


P. 


Initialization Sequirements : none 
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TABLE tt, 2. 2. 5. 1-1 AHGLES_TO_DCH IMTEHPSCE SEQUIEE rtENTS 


1 

J 


1 

1 


1 

■ SOUHCB OE 

1 

1 

1 1 

t 1 

1 

1 SAEPt"' 

1 

1 

Babe 

J DBSCaiBTIOH 


( DESTIHATIOB 

■ TYPE 

j EAtlGH 1 UBIT 

1 BAT" (87) 

t 

1 


1 


1 . 

1 

J 

1 











■Input 

1 


1 

1 


■ 

■ 

1 1 

1 

1 

_1 

|GA BEG 

(Bote i) 

■ mn giubal angles 


■Calling routine 

|A(3)S 

1-180 < K|deg 

1 1 /call 

1 

1 

1 


I 


j 

1 

|<= 1BC 1 

.i_ _ I 

1 

1 


■output 

I 


1 

1 


1 

1 

1 t 

1 

1 

_i 

■8 TO SB 

1 

(Hote 2i 

■ Body to stable aeiabei: 


■Calling routine 

1H(3,3) S 

[-1 <= X ■none 

1 1/call 

1 


1 tcansfornatlon satriK 


1 

1 

■ <= 1 1 

1 

1 


1 


■Kote 1. Input pacaKetec 

naae. ■ 

1 

1 1 

1 

j 

1 

1 

1 


■Calling routine say use 
jnaue. 

any 

legale 

1 

! 

1 

1 1 

1 1 

1 

t 

t 

1 


1 1 

j Hace 2» Assign pacaneter naiae. | 

1 

1 

1 1 

1 

1 

1 

) 


■Calling routine nay use 

any 

legal ■ 

1 

1 1 

1 

1 

j 


I nane . 

. J 


1 

! 

J 1 

1 

1 

_i 


TABLE 4.2. 2.5. 1-2 ASGLES_IO_DCH COBSTAHTS 


( 

■ HAHB 

i 

1 

■ DESCEIPTIOH 

1 

1 

i TYPE 

J_. - 

( 

i VALUE 

t 

1 OBIT 

1 

1 

L 







■DEG_TO_EAD 

1 

■Degrees to radians conversion factor 

|5 

I pi/1 80 

1 - 

■ rad/deg 
L 

1 

L 

■BODY TO BB 
1 

J 

■vehicle to IHD navigation base transf ornation 
lEatrix 

L_ _ _ 

|H{3,3)S 

1 

_ 

■see Bote 
1 

J . 

■ none 
1 

L_ 

1 

1 


0 sin (11°) 

1 0 

0 cos (11°) 


Note 1 j 

body to ns = 


cos (11°) 
0 

-sin (11°) 



4. 2. 2. 5. 2 MODULAR ADD 


Function : This module adds two angles such that the sum 

is in the range -180 to 180 degrees. 

Block Diagram ! Figure 4. 2. 2. 5, 2-1 

Processing Rate : As called 

Interface Requirements : Table 4. 2. 2. 5. 2-1 

Constants : none 


Initial.-.zation Requirements ; none 
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NOTE: This is a scalar operation. For uectar or array inputs. It is performed once for each element. 


Figure 4.2 


i 

! 


2. 5. 2-1. MODUIAR ADD. 
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OEIGJHAI/ PAGE IS 
OF POOR QUAXJTSJ 


to 

o 

H 


TABLE 2. 2, 5* 2-1 HODDLAB^ADD INTERFACE KEOOIEEHENTS 


1 

1 

i 

1 

H&HB 

1 

1 

1 

DESCHIETIOH 


I 

I SOURCE oa 

I DESTINATION 

1 

1 

1 

i .. 

1 1 

1 1 

TYPE 1 RANGE | UNIT 

1 

1 SAHri" 

1 PATE (HZ) 

I 

1 

1 

A 


1 in pats 
J 


1 

i 



I 

1 

1 

1 ; 

1 

1 

1&,B (Note 1} 

{Angles to be aSded 


■invoking routine 

IS 

ITBD !deg 

1 1 /invocation 

t 

J „ . - 


{ 



( 

1 

1 f 

1 

-1 


lOatput 


\ 



1 

1 

i 1 

1 

1 

1 


1 




. 1_. 

1 ' 1 

_J 

.1 

tC (Sote 

2) 

Ibodaiar 

son of A and o 


■ Invoking- routine 

IS 

1-180 < x|deg 

1 1 /invocation 

1 

1 

1 


1 



1 

1 

. 

|<= 180 1 

1 

_ _1 

1 

.1 


1 


{Note 1. 

Input paraaetet 

nane 

!. 1 

1 

1 1 

1 

i 

1 


I Calling 

routine nay use 

any 

legal 1 

I 

1 1 

1 

1 

1 


I nano. 



1 

1 

1 t 

1 

1 

1 

\ 

1 


(Note 2. 

t 

Heturo parameter naae. | 

1 

1 

1 1 

1 t 

} 

1 

( 

J 


■Calling toutine nay use 

any 

legal | 

1 

1 1 

1 

1 

1 


tBaae« 



( 

! 

1 1 

1 

1 

J 


! 



J 

JL.. 

L. J - 

L __ . 

.i 


i 


4. 2. 2, 5. 3 


GA IHCREMENT 


A. 


B. 


C. 


D. 


E. 


Function: This module increments a set of desired IMO 

gimbal angles, and predicts and aecorninodates an IMU gimbal 
flip. It also warns of a gimbal lock condition- The 
desired increments are multiplied by a sign variable 
(+1 or -1) and added to the desired gimbal angles, and 
the sum is tested to see if attainment of the new desired 
angles will result in lock (outer-middle gimbal angle 
within 1/2 degree of +90 or -90 degrees) or in flip (de- 
sired outer-middle gimbal angle greater than +90 degrees 
or less than -90 degrees) . If lock is detected, a flag is 
set- If an impending flip is detected the module does the 
following; 

(1) Increments the desired inner and outer gimbal 
angles by 180 degrees such that the result is 
in the range -180 to +180 degrees. 


(2) Reflects the desired outer-middle gimbal angle 

about the value (+90 or —90 degrees) just passed 
through; e.g-, 91 degrees becomes 89 degrees. 


(3) Reverses the sign of the sign variable for 
future incrementations . 


Block Diagram : Figure 4. 2- 2 -5. 3-1 

Processing Rate ; As called 
Interface Requirements : Teible 4. 2-2. 5-3-1 

Cons tant s ; none 


F. 


Initialization Requirements : none 


FLIP 







T&BLS 4, 2.2.5. 3-1 GA.lHCREKENIE IHTERFACE EEQOlBEHEHTS 


1 

1 

1 UAHE 

« 

S 

5 

1 DESCalPIIQH 

1 

1 SOURCE OB 

1 DESIINATIOM 

1 

1 

1 TIPE 

t 1 

1 1 

1 FANGc 1 UNIT 

i_ 1 

1 

1 SAKPLE 

1 rAi- (uz) 

.._L 

1 

1 

1 

i 


[inputs 

1 

1 

J.__ . - 

1 

.. 1 

1 

1 1 

1 

1 

_i 

[FLIS (Xote 1) 

1 

1 

[Indicator of tupped state of 
[gikibal systen 

1 _ . . 

IBUI Calling routine 
[ 

t 1 
1 

[-1,1 j non e 

1 1 

) 1/call 
1 

I 

1 

-_i 

[DEI (Hote 2) 

1 

[lUD glubal angle increnents 
[ 

1 

[Calling routine 
1 

... .1 ... _ 

|A(3)5 

1 

[-100 < xldeq 
|<= 1BC 1 

i 1 /cal 1 
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4. 2. 2. 5. 4 GIMBALS 10 BODY 


A. gunction ; This module generates a matrix that transforms 
IMD gimbal angle races to vehicle body rates. 

B. Block Diagram : Figure 4. 2. 2. 5. 4-1 

C. Processing Rate i As called 

D- Interface Requirements : Table 4. 2. 2. 5. 4-1 

E. Constants: Table 4. 2. 2. 5. 4-2 


Initialization Requirements: 
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4*2. 2. 5, 5 BODX TO GIMBMrS 


A. Function: This module generates a matrix that transforms 

vehicle body rates to IMU gimbal angle rates. 

B. Block Diagram ; Figure 4. 2. 2. 5. 5-1 

C. Processing Rate : As called 

D. Interface RegTiirements : Table 4. 2. 2.5. 5-1 

E. Constants : Table 4. 2. 2. 5. 5-2 

F . Initialization Requirements : none 
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BODY TO GIMBALS 


Figure 4. 2. 2. 5. 5-1. BODY_TO_GIMBALS . 
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